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在 随机 系统 控制 和 信息 处 理 等 科学 技术 领域 中 ,经 常 遇 到 这 样 一 类 问题 :如 何 滤 
除 物理 系统 中 存在 的 随机 干扰 和 测量 误差 ,或 者 降低 它们 的 影响 ,进而 从 含有 噪声 的 
信号 中 确定 出 系统 的 状态 和 参数 。 这 类 问题 实际 上 属于 信号 去 噪 问题 。 当 有 用 信号 
的 频率 与 噪声 的 频率 不 在 同一 频带 内 或 相差 很 大 时 ,可 以 通过 选 频 的 方法 ( 即 采用 带 
通 滤波 器 ) 将 噪声 滤 除 。 但 实际 上 ,很 多 物理 过 程 中 有 用 信号 的 频率 与 噪声 的 频率 很 
接近 ,而 且 干 扰 和 噪声 往往 具有 随机 性 ,这 样 就 无 法 用 普通 的 滤波 器 将 噪声 滤 除 。 这 
种 情况 下 ,为 了 得 到 有 用 信号 ,只 能 通过 数学 的 方法 处 理 含 品 信 号 ,在 统计 意义 上 确 
定 最 接近 有 用 信号 真 值 的 估计 ,这 就 是 估计 问题 。 如 果 估计 限定 在 某 种 估计 准则 或 
性 能 指标 的 意义 上 , 则 称 为 最 优 估计 。 描 述 最 优 估计 算法 的 一 系列 公式 称 为 最 优 估 
计 器 。 当 估计 状态 的 时 刻 与 最 后 获得 测量 的 时 刻 相同 时 ,估计 问题 也 称 为 滤波 问题 ， 
对 应 有 最 优 滤 波 和 最 优 滤波 器 。 

最 优 估计 理论 的 应 用 范围 很 广 ,涉及 军事 和 民用 的 各 个 工业 领域 。 例 如 ,估计 领 
域 中 出 现 较 早 的 最 小 二 乘法 就 是 高 斯 在 研究 卫星 的 轨道 确定 问题 时 得 到 的 研究 成 
果 。 作 为 系统 状态 估计 的 应 用 ,除了 上 述 的 飞行 器 定 轨 问 题 ,还 有 对 各 类 载体 (如 飞 
行 器 \ 舰 船 及 陆地 车 辆 等 ) 或 系统 的 姿态 进行 估计 的 问题 ,用 于 惯性 导航 、 工 业 过 程控 
制 等 各 类 控制 问题 。 作 为 参数 估计 的 应 用 ,有 系统 的 参数 辨识 .交通 流量 估计 及 水 流 
密度 估计 等 。 系 统 状 态 预 测 中 的 应 用 ,有 天 气 预 报 、 舰 船 姿态 预报 或 动力 系统 负载 的 
预测 等 。 作 为 信号 去 噪 的 应 用 ,有 图 像 处 理 、 雷 达 和 声呐 目标 探测 、. 通 信 信 号 去 噪 及 
各 类 试验 数据 的 处 理 等 。 

在 最 优 估 计 理 论 中 ,由 于 卡尔 曼 滤波 (包括 扩展 卡尔 曼 滤波 ) 具 有 计算 量 小 可 递 
推 计算 ,可 实时 估计 等 特点 ,成 为 导航 领域 中 最 有 力 、 最 有 效 的 滤波 算法 。 近 年 来 , 卡 
尔 曼 滤波 与 信息 融合 算法 相 结 合 ,广泛 应 用 于 航空 、 航 天 、 航 海 及 陆地 车 辆 的 组 合 导 
航 系统 中 。 本 书 在 具体 的 应 用 背景 下 举例 说 明了 卡尔 曼 滤波 的 具体 应 用 。 

本 书 是 作者 在 多 次 为 哈尔滨 工程 大 学 研究 生 讲授 最 优 估计 理论 的 讲义 基础 上 ， 
经 修改 和 补充 ,并 结合 多 年 的 研究 成 果 编 写 而 成 。 全 书 共 10 章 , 由 哈尔滨 工程 大 学 
自动 化 学 院 的 刘 胜 教授 和 张红梅 副教授 共同 编写 ,其 中 , 刘 胜 编写 了 第 1.2.5.6.7 
章 , 张 红 梅 编写 了 第 3.4.8.9.10 章 。 各 章 主要 内 容 如 下 : 

第 1 章 介绍 最 优 估计 问题 的 历史 背景 发 展现 状 、 基 本 概念 ,并 简单 介绍 最 优 估 
计 的 应 用 领域 。 

第 2 章 介绍 随机 数学 理论 ,矩阵 论 和 线性 系统 理论 中 的 一 些 重要 研究 成 果 , 作 为 
学 习 后 续 章节 必 备 的 数学 基础 。 
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第 3 章 介 绍 估计 的 基础 理论 ,包括 常用 的 最 优 估计 准则 、 最 小 二 乘 估计 理论 .最 
小 方差 估计 和 线性 最 小 方差 估计 、 极 大 似 然 估 计 和 极 大 验 后 估计 等 。 

第 4 章 介绍 维 纳 滤波 的 原理 及 应 用 。 首 先 介绍 了 连续 线性 系统 的 维 纳 滤波 原 
理 , 并 利用 变 分 法 导出 维 纳 - 霍 夫 方程 ,之 后 分 别 采用 两 种 方法 讨论 了 维 纳 - 霍 夫 方 程 
的 求解 问题 ,并 通过 具体 的 实例 说 明了 这 两 种 方法 的 应 用 ,最 后 介绍 了 离散 系统 的 维 
纳 滤波 问题 。 

第 5 章 介绍 随机 系统 的 数学 模型 。 首 先 给 出 确定 性 动态 系统 的 数学 模型 ;其 次 
在 考虑 干扰 和 噪声 的 情况 下 得 到 随机 动态 系统 的 数学 模型 ;然后 介绍 连续 模型 与 离 
散 模型 的 相互 转化 ,以 及 非 线 性 模型 的 线性 化 问题 ;最 后 讨论 模型 建立 过 程 中 存在 的 
一 些 实际 问题 。 

第 6 章 介 绍 线性 离散 系统 卡尔 曼 滤波 的 原理 、 滤 波 公式 、 性 质 和 应 用 。 首 先 通过 
直观 法 和 投影 法 推导 滤波 公式 ,并 讨论 含有 控制 项 和 测量 偏差 、 与 系统 干扰 和 测量 噪 
声 相关 ,以 及 有 色 噪 声 等 情况 下 的 滤波 问题 ;其 次 介绍 最 优 预测 和 最 优 平滑 问题 ; 然 
后 讨论 滤波 的 稳定 性 和 鲁 棒 性 ;最 后 以 舰 和 艇 的 状态 估计 问题 为 例 说 明 卡 尔 曼 滤波 
的 具体 应 用 。 

第 7 章 针 对 导致 卡尔 曼 滤波 发 散 的 主要 因素 ,详细 讨论 几 种 防止 滤波 器 发 散 的 
方法 。 

第 8 章 首先 介绍 线性 连续 系统 卡尔 曼 滤波 器 的 两 种 推导 方法 ;其 次 讨论 滤波 的 
稳定 性 问题 ;最 后 对 估计 的 误差 进行 分 析 。 

第 9 章 介绍 几 种 非 线性 系统 的 滤波 方法 :基于 条 件 概率 密度 估计 的 贝 叶 斯 滤波 、 
基于 Taylor 级 数 展开 线性 化 的 扩展 卡尔 曼 滤波 、 基 于 统计 线性 回归 的 Unscented 卡 
尔 曼 滤波 和 中 心 差分 滤波 、 基 于 蒙特 卡 洛 模拟 的 粒子 滤波 、 统 计 线性 化 滤波 及 预测 滤 
波 。 

第 10 章 针对 随机 动态 系统 模型 描述 不 准确 及 噪声 统计 特性 未 知 的 情况 ,讨论 几 
种 自 适应 的 卡尔 曼 滤波 方法 。 

哈尔滨 工程 大 学 自动 化 工程 研究 所 的 张 兰 勇 博 士 完 成 了 本 书 的 校对 及 部 分 实例 
的 仿真 工作 ,在 此 对 张 兰 勇 博士 表示 感谢 。 另 外 ,本 书 在 编写 过 程 中 参考 了 相关 领域 
大 量 的 专著 和 论文 ,在 此 对 这 些 文献 的 作者 表示 感谢 。 

本 书 的 出 版 获得 了 哈尔滨 工程 大 学 “十 一 五 ”研究 生 教 材 建设 专项 资金 的 资助 ， 
在 此 表示 感谢 。 

由 于 作者 水 平 有 限 , 书 中 难免 会 有 一 些 不 足 和 不 妥 之 处 , 敬 请 专家 和 广大 读者 批 
评 指正 。 
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第 1 章 绪 论 


内 容 提要 ”首先 介绍 最 优 估计 问题 提出 的 历史 背景 和 发 展现 状 , 然 后 给 出 最 优 
估计 领域 的 一 些 基本 概念 ,最 后 简单 介绍 最 优 估计 的 应 用 领域 。 


1.1 最 优 估计 理论 


在 通信 和 控制 工程 中 ,经 常 遇 到 的 一 类 问题 是 :如 何 滤 除 系统 的 随机 干扰 和 测 
量 误差 ,或 者 降低 它们 的 影响 ,从 而 从 含 噪 信号 中 确定 被 测量 系统 的 状态 和 参数 。 
当 噪 声 的 频率 与 有 用 信号 的 频率 相差 很 大 时 ,可 以 采用 带 通 滤波 器 将 噪声 滤 除 掉 ， 
从 而 得 到 有 用 信和 号。 但 若 噪声 频率 与 有 用 信号 频率 一 致 ,或 噪声 是 随机 的 ,那么 为 
了 得 到 有 用 信号 ,只 能 在 统计 的 意义 上 通过 数学 的 方法 来 确定 最 符合 有 用 信号 真 值 
“的 一 种 估计 ,这 就 是 估计 问题 。 

在 实际 的 系统 中 ,并 不 是 所 有 的 变量 都 可 以 测量 , 某 些 需 要 研究 的 变量 往往 无 
法 直接 测量 ,如 在 很 多 控制 系统 中 ,反馈 控制 所 需要 的 许多 状态 变量 就 无 法 直接 测 
量 ,而 只 能 测量 和 它们 有 函数 关系 的 一 些 状态 变量 ,这 种 测量 称 为 间接 测量 。 在 测 
量 的 过 程 中 ,往往 带 有 一 些 随 机 的 测量 噪声 。 这 时 ,为 了 获得 所 要 研究 的 状态 变量 
值 ,就 需要 对 试验 数据 加 以 处 理 , 根 据 测 量 量 和 状态 变量 的 函数 关系 去 推算 所 需 的 
状态 变量 值 ,这 种 推算 的 过 程 就 是 估计 。 众 多 的 数学 家 和 物理 学 家 在 这 方面 做 出 了 
重要 的 贡献 ,在 大 量 的 研究 和 试验 基础 上 形成 了 估计 理论 。 估 计 理 论 所 研究 的 对 象 
是 随机 现象 ,是 根据 受 干扰 的 量 测 数 据 来 估计 关于 随机 变量 、 随 机 过 程 或 系统 某 些 
特征 的 一 种 科学 方法 。 

估计 问题 可 分 为 两 类 :一 是 经 典 估计 ,也 可 称 为 参数 估计 或 静态 估计 ,其 特点 是 
依据 量 测 方程 由 量 测 数 据 来 估计 系统 的 参数 或 状态 。 经 典 估计 本 质 上 属于 概率 论 
和 数理 统计 理论 的 一 个 分 支 。 二 是 现代 估计 ,也 称 为 状态 估计 或 过 程 估计 ,其 特点 
是 依据 动态 的 状态 方程 和 量 测 方程 ,由 量 测 数据 来 估计 系统 的 状态 。 现 代 估计 是 现 
代 控 制 理论 、 计 算 机 技术 与 概率 论 数理 统计 相 结合 的 产物 ,是 现代 控制 理论 的 一 个 
重要 分 支 。 本 书 重点 研究 的 是 第 二 类 问题 。 

所 谓 最 优 估计 ,是 从 某 种 意义 上 来 说 是 最 好 的 估计 。 最 优 估计 理论 研究 的 开始 
可 以 追溯 到 1632 年 伽利略 (Galilei) 的 贡献 ,他 尝试 用 各 种 误差 函数 最 小 化 的 方法 提 
出 估计 理论 问题 。 随 后 ,一 系列 研究 者 在 这 方面 开展 过 工作 ,但 是 到 现在 仍然 使 用 
的 著名 方法 是 最 小 二 乘 估计 。 它 是 高 斯 (Gauss) 在 1795 年 帮助 天 文学 家 确定 谷 神 
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星座 的 位 置 计算 工作 时 ,采用 的 一 种 随机 变量 的 数据 处 理 方法 。 一 百 多 年 后 ( 约 
1910 年 ) ,从 事 概率 密度 研究 的 费 软 尔 (Fisher) 提 出 了 极 大 似 然 估计 法 ,对 估计 理论 
的 广泛 课题 作出 了 又 一 大 贡献 。 

在 20 世纪 40 年 代 的 最 初 几 年 中 , 维 纳 (Wiener) 和 柯 尔 莫 哥 洛 夫 (Kornmoro6pos) 
开始 将 统计 的 方法 应 用 于 通信 系统 和 控制 系统 的 研究 中 。 维 纳 的 工作 是 从 研究 统 
计 平 稳 的 随机 序列 开始 的 ,他 证 明 : 在 一 定 条 件 下 ,平稳 随机 序列 的 时 间 平 均等 于 相 
平均 , 维 纳 就 是 基于 这 点 提出 了 著名 的 维 纳 滤波 理论 。 维 纳 滤波 是 统计 最 优 滤波 器 
的 一 种 频 域 设计 法 ,充分 利用 了 输入 信号 和 量 测 信 号 的 统计 特性 ,通过 求解 维 纳 - 霍 
夫 方 程 得 到 最 佳 滤波 器 的 冲 激 响 应 ,给 出 了 最 小 均 方 误差 意义 下 的 第 一 个 明确 解 。 
在 一 般 情 况 下 ,求解 维 纳 - 霍 夫 方程 存在 极 大 的 困难 。 此 外 , 维 纳 滤波 只 适用 于 平稳 
随机 过 程 且 已 知 有 理 谱 密度 的 情况 , 且 不 能 对 数据 进行 实时 处 理 。50 年 代 中 期 ,这 
种 滤波 方法 已 经 不 能 满足 实际 应 用 的 需要 。 

1960 4E , RK% (Kalman) 和 布 西 (Bucy) 首 次 将 现代 控制 理论 中 的 状态 空间 思 
想 引 入 最 优 滤波 理论 ,提出 了 最 优 递 推 滤波 法 , 即 卡尔 曼 滤波 器 (Kalman Filter, 
KEF)。 卡 尔 曼 也 是 以 估计 误差 方差 最 小 为 准则 ,但 是 用 状态 方程 和 观测 方程 描述 系 
统 的 动态 模型 和 观测 模型 。 卡 尔 曼 滤波 是 一 种 时 域 递 推 的 方法 ,可 用 于 时 变 、 非 平 
稳 和 多 维 信号 的 估计 ,便于 计算 机 实现 。 

卡尔 曼 最 初 提出 的 滤波 理论 只 适用 于 线性 系统 。 但 是 ,因为 大 多 数 现实 问题 的 模 
型 本 来 就 具有 非 线 性 ,如 许多 通信 中 的 调制 方法 及 火箭 制导 与 控制 问题 ,因此 必然 导致 
发 展 非 线性 滤波 算法 。 但 是 , 非 线性 滤波 问题 在 理论 上 比 线性 滤波 问题 要 困难 和 复杂 
得 多 。 对 于 非 线性 系统 ,适用 于 线性 系统 的 很 多 条 件 和 性 质 已 经 不 再 成 立 ,因此 对 于 非 
线性 系统 ,无 法 得 到 其 闭 形式 的 解 ,也 就 无 法 建立 衡量 最 优 解 的 准则 。 . 

为 了 将 卡尔 曼 滤波 推广 应 用 到 非 线性 领域 , 布 西 等 人 在 提出 线性 卡尔 曼 滤波 理 
论 之 后 又 提出 了 扩展 的 卡尔 曼 滤波 (Extended Kalman Filtering，EKF) 理 论 。EKF 
采用 一 阶 线性 化 的 方法 来 近似 非 线性 系统 函数 ,得 到 的 是 次 优 滤波 方法 。 与 之 类 似 
的 方法 还 有 标 称 状态 滤波 法 。 由 于 这 类 方法 是 将 非 线性 函数 按 泰勒 级 数 展开 ,并 截 
取 一 阶 项 的 结果 ,因此 近似 精度 仅 为 一 阶 。 为 了 提高 近似 精度 ,可 以 在 展开 式 二 阶 
项 以 后 进行 截断 ,这 样 就 得 到 二 阶 滤 波 , 可 将 近似 精度 提高 至 二 阶 。 

比较 精确 的 非 线性 滤波 方法 是 概率 滤波 法 和 统计 法 。 基 于 概率 滤波 的 主要 思 
想 是 :将 系统 方程 的 滤波 问题 转化 为 计算 状态 基于 观测 信息 的 条 件 概率 密度 函数 的 
问题 ,随机 状态 估计 的 完全 解 就 是 状态 的 条 件 概率 密度 函数 ,但 实际 上 却 很 难 求 出 。 
基于 统计 的 估计 方法 是 通过 增加 观测 数目 的 方法 减 小 估计 误差 ,将 估计 问题 转化 为 
使 误差 最 小 化 的 确定 性 方法 ,其 典型 代表 是 20 世纪 90 年 代 出 现 的 粒子 滤波 器 。 在 
理论 上 ,选用 的 粒子 数 越 多 , 解 的 精确 度 就 越 高 ,但 引起 的 另 一 个 问题 是 计算 量 也 随 
之 增加 。 
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1.2 估计 理论 基本 概念 


1. 最 优 估计 问题 的 一 般 提 法 

假设 要 估计 的 随机 变量 x 无 法 直接 观测 ,需要 通过 观测 与 x 统计 相关 的 随机 变 
量 z 来 对 x 进行 估计 。 已 知 关 于 系统 运动 学 或 动力 学 和 量 测 方程 的 知识 , 即 给 定 系 
统 模型 和 观测 模型 的 情况 下 ,利用 系统 过 程 噪声 、 量 测 噪声 的 统计 特性 和 初始 条 件 
信息 ,依据 某 种 最 优 准则 对 量 测 值 = 进行 处 理 ,确定 系统 当前 时 刻 状态 x 的 问题 , 称 
为 最 优 估计 问题 。 

x 的 最 优 估计 值 用 表示 ,一 般 是 变量 z 的 函数 g&(xz), 即 2 一 &(Cz)。 因 此 ,全 本 
身 也 是 随机 变量 。g(z) 可 以 是 任意 形式 的 函数 ,但 在 某 些 情况 可 以 限定 为 观测 变量 
z 的 某 个 特定 形式 的 函数 ,如 线性 函数 或 多 项 式 函数 等 。 

2. 最 优 估计 器 

实现 最 优 估计 的 算法 或 系列 公式 称 为 最 优 估计 器 或 最 优 滤波 器 。 

3, 估计 误差 

估计 误差 8 定义 为 真实 值 x 和 估计 值 的 差 *, BJ 

se 二 x— 

估计 误差 可 以 用 来 评价 估计 的 效果 ,当然 ,估计 误差 越 小 ,估计 效果 越 好 。 由 x 和 至 
是 随机 变量 可 知 ,估计 误差 也 是 随机 变量 ,因此 常用 其 均值 E(x — £) 和 方差 
EL(x 一 4)?] 来 描述 。 

4. 滤波 

“滤波 ”是 与 估计 有 关 的 一 个 概念 。“ 估 计 ” 的 说 法 源 于 控制 领域 ,而 “滤波 ” 源 于 
通信 理论 。 工 程 上 的 滤波 问题 在 理论 上 是 一 类 统计 估计 问题 。 最 优 滤波 实际 上 是 
最 优 估计 的 一 类 方法 。 从 数学 的 观点 看 ,滤波 理论 是 统计 学 中 估计 理论 的 一 个 重要 
分 支 ;从 工程 的 观点 看 , 它 又 是 系统 工程 研究 的 一 个 重要 组 成 部 分 。 

5. 最 优 估计 准则 

说 估计 结果 是 “最 好 ”的 ,应 该 基于 某 个 特定 的 评价 标准 ,这 个 评价 标准 就 是 最 
优 估计 准则 。 最 优 估计 准则 是 使 某 种 性 能 指标 达到 极 大 或 极 小 的 准则 。 选 择 不 同 
的 性 能 指标 ,就 得 到 不 同 的 最 优 估计 准则 ,而 不 同 的 估计 准则 ,将 最 终 导致 不 同 的 最 
优 估计 方法 。 因 此 ,在 某 一 准则 下 是 最 优 的 估计 ,在 另 一 准则 下 未 必 还 是 最 优 的 。 

6. 性 能 测度 

性 能 测度 即 性 能 指标 ,是 用 以 判断 估计 最 优 性 的 标准 ,一 般 用 J 表示 。 J 可 以 有 
很 多 函数 形式 ,最 常用 的 是 代价 函数 的 期 望 值 。 这 里 ,代价 函数 是 估计 误差 = 的 函 
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数 ,表示 为 Cle). 这 种 测度 称 为 贝 叶 斯 性 能 测度 ,可 以 由 下 式 表示 : 
J = ELC(e)] 

得 到 的 相应 估计 值 称 为 贝 叶 斯 估计 。 

由 观测 < 得 到 对 zx 的 贝 叶 斯 估计 由 式 交 一 gG) 给 出 。 这 里 , g(z) 是 使 上 述 最 小 
的 函数 。 如 果 C(s) = Z, 则 性 能 测度 称 为 均 方 误差 ,此 时 g(z) 将 是 x 的 最 小 均 方 误差 
估计 。C(*) 也 常 选 作 平均 绝对 误差 和 平均 均匀 误差 。 均 方 误差 与 它们 相 比 ,通常 需要 
更 少 的 统计 信息 而 且 更 易于 数学 计算 ,因此 常 选择 均 方 误差 作为 性 能 评价 准则 。 

7. 最 优 估计 的 分 类 

按照 状态 估计 的 时 间 所 与 最 后 量 测 时 间 上 的 关系 ,最 优 估计 问题 可 分 为 三 类 ， 

D H a > t， 即 进行 状态 估计 的 时 间 在 最 后 量 测 的 时 间 之 后 ; 

(2) 滤波 三 = t, 即 进行 状态 估计 的 时 间 与 最 后 量 测 的 时 间 相同 ; 

(3) 平滑 所 < t, 即 进行 状态 估计 的 时 间 在 最 后 量 测 的 时 间 以 内 。 

本 书 重 点 讨论 滤波 问题 。 


1.3 最 优 估计 应 用 领域 


最 优 估计 理论 的 应 用 很 广 , 如 飞行 器 轨道 确定 、 雷 达 目 标 状态 估计 ,惯性 导航 、 工 业 过 
程控 制 , 信 号 去 噪 、 系 统 模型 参数 辨识 ,统计 图 像 增强 ,交通 密度 估计 ,河水 流量 估计 动力 
系统 负载 预测 ,实验 数据 处 理 , 核 医学 中 示 踪 物 的 研究 及 向 量 心电图 分 类 等 。 

下 面 介绍 几 个 估计 理论 应 用 的 例子 。 

例 1.1 系统 控制 问题 。 通 过 对 系统 运行 状态 进行 控制 ,使 系统 能 够 始终 工作 
在 最 佳 状态 。 为 此 ,需要 对 系统 状态 有 关 的 物理 量 不 断 地 观测 ,并 对 其 观测 数据 进 
行 分 析 处 理 ,去 掉 误差 信号 ,得 到 与 系统 状态 有 关 的 控制 信号 ,使 控制 系统 按 预期 的 
要 求 状态 运行 。 这 时 ,观测 量具 有 如 下 形式 : 

z(t) = hx), v t) ,t] 
式 中 , 20) 为 m 维 观测 向 量 ; h["] 为 已 知 的 向 量 函 数 ; x(G) 为 n 维系 统 状态 向 量 ; 
v ( 为 n 维 随机 观测 误差 。 为 了 得 到 与 系统 状态 有 关 的 控制 信号 ,首先 要 解决 由 
aCe) 估计 x(2) 的 问题 。 

例 1.2 通信 问题 。 通 信 系统 中 的 一 个 重要 问题 是 如 何 从 接收 信号 中 提取 被 发 
送 的 信息 。 由 于 大 气 品 声 和 电路 噪声 的 干扰 ,所 接收 到 的 信号 不 是 发 送 的 信和 号 
XO, 而 是 xG) +n(O ,nlz) 为 噪声 信号 。 这 样 ,通信 系统 的 主要 问题 就 是 如 何 从 接 
收 到 的 信号 z(t) = x(z) 十 n(z) 中 滤 掉 nO, 而 将 有 用 信号 尽 可 能 恢复 出 来 ,也 就 是 
由 z( 估计 x(z)。 

例 1.3 验 后 数据 处 理 。 以 导弹 飞行 状态 为 例 。 在 飞行 试验 中 ,如 果 已 由 地 面 
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跟踪 系统 和 遥测 系统 观测 记录 到 了 导弹 飞行 参量 z(0) , 它 与 飞行 状态 xG) 及 观测 误 
差 v GQ) 之 间 的 关系 为 

z(t) = h[x(t),v (t) ,t] 
这 样 ,在 试验 以 后 为 了 得 到 导航 精度 并 分 析 导 航 系统 的 误差 ,就 需要 根据 观测 数据 
z(t) 以 估计 导弹 飞行 状态 x0). 

例 1.4 系统 辨识 问题 。 一 种 简单 的 辨识 方法 是 利用 系统 输入 和 输出 的 观测 数 
据 估 计 系 统 模型 中 的 参数 。 

在 最 优 估计 理论 中 ,卡尔 曼 滤 波 ( 包 括 扩展 卡尔 曼 滤波 ) 是 最 典型 ,也 是 应 用 最 
普遍 的 方法 。 随 着 计算 机 的 发 展 日 益 广泛 , 它 的 应 用 已 遍及 各 个 领域 。 例 如 ,美国 
阿波 罗 计 划 中 , 登 月 舱 与 指挥 舱 的 会 合 ,就 是 采用 卡尔 曼 滤波 对 登 月 舱 载 雷达 测量 
数据 进行 处 理 以 获得 关于 位 置 与 速度 的 估计 ,达到 会 合 的 目的 。 又 如 ,空中 交通 管 
制 系统 对 飞机 航 迹 进行 估计 ,以便 完成 导航 的 任务 。 又 如 ,雷达 对 弹道 式 再 人 体 用 
卡尔 曼 滤 波 作 轨 道 估计 和 弹 着 点 预测 。 再 如 ,跟踪 雷达 采用 卡尔 曼 滤波 实现 机 动 目 
标 跟 踪 。 在 工业 控制 中 也 有 采用 卡尔 曼 滤 波 解 决 氧气 炼 钢 问 题 ,用 卡尔 曼 滤 波 从 排 
气 中 一 氧化 碳 的 分 压 来 估计 炉 温 及 钢水 含 碳 量 。 其 他 领域 也 开始 运用 卡尔 曼 滤波 ， 
如 原子 反应 堆 、 电 力 站 、 化 工 、 气 象 和 水 文 地 质 等 。 

卡尔 曼 滤波 最 成 功 的 应 用 是 在 导航 领域 中 。 对 于 导航 变量 的 修正 ,以 前 只 是 参考 外 
部 的 测量 值 ,但 这 种 作法 忽略 了 两 个 事实 :第 一 ,外 部 测量 值 本 身 含 有 随机 误差 ,这 种 误差 
与 导航 误差 相 比 , 可 能 是 显著 的 ;第 二 ,导航 系统 的 误差 主要 是 由 随机 而 时 变 的 导航 传 感 
器 误差 所 引起 的 。 可 以 利用 卡尔 曼 滤波 器 处 理 导航 系统 传感器 的 输出 ,以 得 到 所 考察 过 
程 的 “最 好 ”估计 值 。 这 样 ,可 以 最 佳 利 用 外 部 测量 值 和 导航 系统 提供 的 结果 ,因此 能 够 得 
到 比 只 利用 外 部 测量 值 ,或 只 利用 导航 系统 时 更 高 的 导航 精度 。 

卡尔 曼 滤波 可 以 根据 单一 传感器 在 单一 过 程 中 提出 ,也 可 由 多 传感器 和 多 过 程 
提出 。 随 着 导航 技术 的 发 展 及 对 导航 精度 的 要 求 ,组 合 导航 已 经 成 为 普遍 的 导航 方 
式 ,因此 卡尔 曼 滤波 常用 于 多 传感器 系统 。 这 时 ,可 以 针对 多 个 子 系统 ,设计 并 行 的 
卡尔 曼 滤波 器 组 , 即 联邦 卡尔 曼 滤波 。 其 中 的 每 个 子 滤波 器 各 自 独立 运行 ,最 后 将 
各 个 子 滤波 器 的 输出 结果 进行 融合 ,以 获得 整个 系统 的 状态 估计 结果 。 采 用 这 种 滤 
波 器 结构 的 优点 是 设计 灵活 ,容错 性 能 好 且 各 个 子 滤波 器 的 计算 量 也 较 小 。 

值得 一 提 的 还 有 粒子 滤波 。 由 于 它 可 用 于 非 线性 一 非 高 斯 系统 ,因此 对 于 估计 
精度 要 求 高 的 问题 ,粒子 滤波 是 值得 考虑 的 滤波 方法 。 虽 然 粒 子 滤波 对 计算 量 的 要 
求 过 大 ,但 是 随 着 微 处 理 器 的 快速 发 展 ,滤波 的 实时 实现 已 指日可待 。 粒 子 滤波 近 
些 年 来 在 运动 目标 的 跟踪 研究 方面 获得 了 长 足 的 发 展 ,如 对 导弹 和 水 下 目标 的 跟踪 
问题 ,机 器 人 的 路 径 规划 等 。 

可 以 说 ,最 优 估计 理论 的 应 用 已 渗透 到 工业 生产 的 各 个 领域 ,是 一 种 值得 掌握 
的 专业 理论 。 
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内 容 提要 ”为 了 方便 后 续 章 节 的 学 习 和 讨论 ,本 章 介绍 一 些 必 备 的 数学 基础 知 
识 , 主 要 包括 概率 论 和 随机 过 程 的 基础 理论 、 线 性 系统 对 平稳 随机 过 程 的 响应 、 正 交 
投影 理论 ,以 及 矩阵 基本 理论 。 本 章 还 介绍 了 一 类 特殊 的 随机 过 程 一 一 海浪 。 介 绍 
了 海浪 的 模型 ,仿真 及 其 概率 阅 值 预报 问题 。 


21 概率 论 


2.1.1 事件 与 概率 


1. 事件 及 运算 关系 

从 某 一 研究 任务 出 发 ,对 随机 现象 进行 观察 和 实验 , 称 为 随机 试验 。 

在 一 定 条 件 下 ,随机 试验 中 可 能 出 现 也 可 能 不 出 现 的 事件 称 为 随机 事件 ,简称 
事件 ,用 字母 A,B,C,… 表示。 在 一 定 条 件 下 必然 发 生 的 事件 称 为 必然 事件 ;在 一 定 
条 件 下 必然 不 发 生 的 事件 称 为 不 可 能 事件 。 

试验 中 每 一 种 可 能 产生 的 结果 称 为 基本 事件 。 所 有 的 基本 事件 组 成 一 个 空间 ， 
称 为 样本 空间 ,用 0 表示 。 其 中 的 每 一 个 基本 事件 称 为 该 样本 空间 中 的 一 个 样本 
点 ,用 表示。 

描述 不 同事 件 A 和 BB 之 间 关系 的 数学 方法 称 为 事件 的 运算 代数 。 其 基本 的 运 
算法 则 有 以 下 几 种 : 

(1) 包 含 。 如 果 事件 A 发生 ,导致 事件 B 也 必然 发 生 , 则 称 事件 A 包括 于 事件 
B ,或 称 事件 B 包 含 事件 A, 记 作 ACB 或 B 汪 A。 

(2) 等 价 。 若 事件 ACB 且 B C A, 则 称 A 与 B 是 等 价 的 , 记 为 A = B, 

(3) 并 。 如 果 事 件 A 与 事件 B 至 少 有 一 个 事件 发 生 , 或 者 二 者 同时 发 生 , 称 为 A 
与 B 的 并 ,或 A 与 B 的 和 , 记 为 A U B 8 A + B, 可 推广 到 个 事件 Al,As，,…,A， 


mem Ü A R DA 

(4) 差 。 表 示 事 件 A 发 生 而 事件 B 不 发 生 的 事件 , 称 为 A 与 B 的 差 , 记 为 A\B 
或 A 一 B。 

ORX. MRR A 和 事件 BB 同时 发 生 , 称 为 A 与 B 的 交 , 或 A 与 B 的 积 , 记 为 


A N B 或 4B。 可 推广 到 个 事件 A1,As,…,A, HEB Å A: R TTA 
i=l 
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(6) 互 斥 。 如 果 事 件 4 与 B 不 可 能 同时 发 生 , 即 AB — @, 则 称 事件 4 与 B 是 互 
斥 的 ,或 者 说 是 不 相 容 的 。 

(7) 对 立 。 WRAN B= @ B A U B= 0, 则 称 B 为 A 的 对 立 事 件 , 记 为 B= A, 

OZE. WRF A ,A。,…,A 在 每 次 试验 中 至 少 有 一 个 发 生 , 即 A, U A, 
U U A, = G, 则 称 {Al,A:,…,A,) 构成 一 个 事件 完备 组 ;特别 地 , 当 A; N A, = 
PGA j), WEK (A.A... A.) 是 两 两 互 斥 的 事件 完备 组 。 

随机 事件 的 代数 运算 法 则 主要 有 : 

(DA+A= A; 

(2) AA =A; 

(3) A+B= B+A; 

(4) AB = BA; 

(S) A+ (B+O) = (A+ B) +G; 

(6) A(BC) = (AB)C; 

(7) AB +0) = AB+AC; 

(8) A+ (BC) = (4 十 B)(4 十 C)。 

值得 注意 的 是 ,随机 事件 的 运算 不 同 于 普通 代数 中 数 的 运算 。 例 如 , C = A+ B 
不 同 于 数 运算 的 加 法 , C = AB 不 同 于 数 运算 的 乘法 。 

2. 概率 及 基本 公式 

DHR 

概率 的 定义 有 多 个 ,例如 古典 概率 、 几 何 概率 、 统 计 概 率 和 数学 定义 ,这 里 只 介 
绍 其 中 的 两 个 。 

(1) 概 率 的 统计 定义 。 

概率 是 对 随机 事件 发 生 的 可 能 性 的 一 种 定量 描述 。 假 定 在 相同 的 条 件 下 进行 
了 nn 次 试验 (x 足够 大 ) ,其 中 事件 A RET m 次 , 则 事件 A 发 生 的 频率 f CA) 定义 为 


fA) = 5 (2.1.1) 


采用 不 同 批 的 =” 次 试验 , 求 得 事件 A 发 生 的 频率 可 能 会 完全 不 等 。 如 果 试 验 次 
数 n 足够 大 , 则 利用 各 批 试验 所 求 得 的 频率 值 f(A) 将 接近 某 一 个 固定 的 常数 
PA), 称 PA) 为 事件 A 发 生 的 概率 。 如 此 定义 的 概率 称 为 统计 概率 。 

(2) 概 率 的 数学 定义 。 

设 下 是 由 样本 空间 0 的 一 些 子 集 构成 的 一 个 o- 域 , 即 下 满足 下 面 的 条 件 : 

DAEF; 

@#A EF, WAE FC = AA); 


OFA € FG = 1,2,=), MA Ü A € F. 
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则 这 个 o- 域 下 称 为 事件 域 ,F 中 的 元 素 称 为 事件 , Q 称 为 必然 事件 ,而 @ 称 为 不 可 能 
事件 。 

设 书 是 定义 在 事件 域 F 上 的 一 个 实 值 集 函 数 ,如 果 它 满足 以 下 三 个 条 件 ， 

@ 对 于 每 一 AE F, 有 0 过 P(A) <L; 

四 对 于 必然 事件 Q, APM = 1; 

@ 对 于 任意 A: € FG = 1,2,---),A, NA = @G = ;), H 

P(Ü A.) = DPA) 

称 实 值 集 函 数 P 为 事件 域 F 上 的 概率 ,并 称 PCA) 为 事件 A 的 概率 。 

现代 概率 是 建立 在 上 述 事 件 域 定义 基础 上 的 。 与 古典 概率 相 比 ,现代 概率 的 定 
义 将 随机 事件 扩展 为 连续 变化 的 随机 变量 。 此 时 ,样本 空间 O 和 事件 域 下 都 是 n 维 
欧式 空间 ,概率 也 是 一 个 连续 的 实 函 数 , 即 概率 分 布 函 数 P(A), 简称 概率 函数 。 对 
于 任意 一 个 事件 集合 A € F, 总 可 以 找到 一 个 概率 函数 ,其 取 值 在 0 到 1 之 间 , 即 概 
率 函数 可 以 看 作 是 事件 域 下 中 某 个 集合 A 在 [0,1] 域 中 的 一 个 映射 。 

12 Q 是 样本 空间 ,下 是 事件 域 ,P 是 概率 函数 , 则 称 三 元 体 ( F, PHERS 
间 。 其 中 ,样本 空间 Q 为 实验 可 能 出 现 的 所 有 结果 构成 的 集合 ,事件 域 F 为 感 兴趣 
的 事件 或 集合 所 组 成 的 一 个 群 ,P 为 每 一 个 感 兴趣 的 事件 或 集合 的 概率 。 

2) 概 率 的 基本 性 质 

(Do<P(A) <1; 

(2) 对 于 必然 事件 Q, 有 PC0) = 1， 

(3) 对 于 不 可 能 事件 ,有 PO) = 0 ; 

(4) P(A U B) = P(A) +P(B)— P(A N B), 
车 A 和 B 互 斥 , 则 有 PCA U B) = PA) + PCB) ; 

6# ADB, W P(A) > PB); 

(© A DB, IJ P(A | B) > P(A) — P(B) ; 

(7) 对 于 任 一 事件 A, 有 P(A) =1— PA); 

(OH A ,4:，…,A, 是 两 两 互 斥 的 事件 完备 组 , 则 

P(A, U A; U e U A,) = PCA) HPA) HeH PCA) 一 1 
3) 独 立 性 
若 事件 A.A... An 中 ,任意 mn 个 (2 < m < ) 事 件 都 满足 如 下 关系 式 : 


P(A)= Il Pao 
即 联合 事件 的 概率 是 简单 事件 概率 的 乘积 , 则 称 Ar. A... An 相互 独立 。 这 意味 着 
事件 组 中 任何 一 个 事件 的 出 现 都 与 其 他 事件 的 出 现 无 关 。 


4) 条 件 概率 
对 于 不 独立 事件 “条 件 概率 ”的 概念 可 以 提供 更 多 的 信息 。 在 已 知事 件 B 出 现 
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的 条 件 下 ,事件 A 出 现 的 概率 表示 为 


P(A | B) = PAB) 


P@) 

称 P(A | B) 为 在 事件 B 发 生 的 条 件 下 事件 A 发 生 的 条 件 概率 。 

简单 地 说 ,条 件 概率 就 是 在 一 定 附 加 条 件 下 的 事件 概率 。 从 广义 上 看 ,任何 概 
率 都 是 条 件 概率 ,因为 任何 事件 都 是 产生 于 一 定 条 件 下 的 试验 或 观察 ,但 这 里 所 说 
的 “附加 条 件 ” 是 指 除 试验 条 件 之 外 的 附加 信息 ,这 种 附加 信息 通常 表现 为 “已 知 某 
茶 事 件 发 生 了 ”。 显 然 ,车 事件 A 与 B 独立 , 则 条 件 概率 P(A | B) 转换 为 简单 概率 
PA). 

将 条 件 概率 公式 (2. 1. 2) 进 行 变形 ,可 得 乘法 公式 , 即 

P(AB) = P(B)P(A | B)(P(B) > 0) (2. 1.3) 

上 述 公式 可 推广 到 ”个 事件 的 情形 。 

5) 全 概率 公式 

设 事件 组 Bi ,B:，… 互 斥 , 即 BB, = OG > j), R. 


ÜB=a R P(ÜB)=1,P0B)>0G = 2, 
则 对 任 一 事件 A, 有 


《2. 1.2) 


P(A) = Z PBPA | BÐ (2.1.4) 
称 此 式 为 全 概率 公式 。 
6) 贝 叶 斯 公式 
在 条 件 概率 公式 (2. 1. 2) 中 ,A 35 B 是 可 以 交换 的 ,所 以 可 得 
P(A | B)P(B) = P(B | A)P(A) 
再 结合 式 (2. 1. 3) ,可 将 条 件 概率 公式 重 写 为 
PA | B) = PB LOPA 


在 B 已 出 现 的 条 件 下 ,考虑 所 有 可 能 的 结果 A;(i = 1,2,…) 
PC | p = PB LADPAD 


由 于 Ai(i = 1,2,…) 互 斥 ,因此 
P(B) = P(B | ADP(A;) + P(B | A) P(A?) 十 … 
因此 有 
P(A, | p  _PGB1ADPCAD 
D PG | ADP) 
i=l 


称 此 式 为 贝 叶 斯 公式 。 这 一 公式 最 早 发 表 于 1763 年 ,当时 贝 叶 斯 已 经 去 世 ,其 结果 


(2.1.5) 
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没有 受到 应 有 的 重视 ,后 来 人 们 才 逐 渐 认 识 到 了 这 个 著名 概率 公式 的 重要 性 。 现 
在 , 贝 叶 斯 公式 及 根据 它 发 展 起 来 的 贝 叶 斯 统计 已 成 为 机 器 学 习 、 人 工 智能 、 知 识 发 
现 等 领域 的 重要 工具 。 

贝 叶 斯 公式 给 出 了 “结果 ”事件 B 已 发 生 的 条 件 下 , “原因” 事件 的 条 件 概率 。 从 
这 个 意义 上 讲 , 它 是 一 个 “ 执 果 索 因 ” 的 条 件 概率 计算 公式 。 相 对 于 事件 B 而 言 , 概 
率 论 中 把 P(A) 称 为 先 验 概率 (Prior Probability) ,而 把 PCA | B) 称 为 后 验 概率 
(Posterior Probability) ,这 是 在 已 有 附加 信息 ( 即 事件 B 已 发 生 ) 之 后 对 事件 发 生 的 
可 能 性 做 出 的 重新 认识 ,体现 了 已 有 信息 带 来 的 知识 更 新 。 


2.1.2 随机 变量 的 概率 分 布 


1. 随机 变量 及 其 概率 分 布 

1) 随 机 变量 

所 谓 随机 变量 ,就 是 每 次 试验 可 能 取 不 同 值 的 量 。 例 如 , 某 一 事件 内 公共 汽车 
站 等 车 的 乘客 人 数 ,电话 交换 台 在 一 定时 间 内 收 到 的 呼叫 次 数 等 。 由 于 随机 变量 可 
以 表示 样本 空间 中 一 切 可 能 的 样本 点 ,所 以 可 以 表示 为 样本 点 的 函数 X(ow) 。 一般 将 
随机 变量 的 自 变量 省 略 , 记 为 X。 

随机 变量 在 不 同 条 件 下 由 于 偶然 因素 的 影响 , 可 能 取 不 同 的 值 ,具有 不 确定 性 
和 随机 性 ,但 这 些 取 值 落 在 某 个 范围 内 的 概率 是 一 定 的 , 即 对 于 任何 实数 z, X < = 
具有 确定 的 概率 。 因 而 可 以 说 ,随机 变量 是 在 一 定 范围 内 以 一 定 的 概率 分 布 随机 取 
值 的 量 。 例 如 ,分 析 测试 中 的 测定 值 ,虽然 被 测定 量 的 取 值 可 能 在 某 一 范围 内 随机 
变化 ,具体 取 什 么 值 在 测定 前 无 法 确定 ,但 测定 的 结果 是 确定 的 ,多 次 重复 测定 值 具 
有 统计 规律 性 。 随 机 变量 与 模糊 变量 的 不 确定 性 的 本 质 差 别 在 于 ,后 者 的 测定 结果 
仍 具 有 不 确定 性 , 即 模糊 性 。 

随机 变量 按照 所 取 的 值 是 否 可 列 , 分 为 两 种 基本 类 型 。 

离散 型 随机 变量 。 即 在 一 定 区 间 内 变量 取 值 为 有 限 个 ,或 数值 可 以 一 一 列举 
出 来 。 例 如 某 地 区 年 人 口 的 出 生 数 、 死 亡 数 , 某 药 治疗 某 病 病 人 的 有 效 数 、 无 效 数 等 。 

@ 连 续 型 随机 变量 。 即 在 一 定 区 间 内 变量 取 值 有 无 限 个 ,或 数值 无 法 一 一 列举 
出 来 。 例 如 某 地 区 男性 健康 成 人 的 身高 .体重 值 等 。 

2) 概 率 分 布 

随机 变量 X 的 取 值 小 于 或 等 于 实数 z 事件 的 概率 P{X 壹 zx} 是 工 的 函数 , 称 为 
和 的 概率 分 布 函数 ,简称 分 布 函数 , 记 为 F(z), Bl 

F(z) = P(X < z}(— 0 < z < co) (2.1.6) 
分 布 函数 F(z) 具有 以 下 主要 性 质 。 
《1) 有 界 性 :0 委 FGz) < 1; 
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DAME: a <b, WA F(a) < F(b) ; 

(3) 极 限 情况 : lim Fa) 一 0,limF(z) =1; 

(4) Pla < X <b} = F) — Fla). 

需要 指出 的 是 ,如 果 随 机 变量 等 于 某 一 确定 的 数值 , 则 这 一 事件 的 概率 应 等 于 
0, 即 如 果 a 为 某 确定 的 数值 , 则 F(a) = 0。 这 并 不 说 明 XX 二 a 不 可 能 发 生 ,只 是 表示 
在 大 量 的 试验 结果 中 ,发 生 这 种 情况 的 概率 极 小 。 

概率 分 布 函数 完整 地 代表 了 一 个 随机 变量 的 统计 特性 。 因 此 ,如 果 两 个 随机 变 
量具 有 相同 的 概率 分 布 函数 ,可 以 认为 这 两 个 随机 变量 是 等 值 的 。 

由 式 (2. 1, 6) 可 以 看 出 ,如 果 给 定 随机 变量 的 取 值 范围 , 则 可 利用 其 概率 分 布 函 
数 计算 其 概率 。 

下 面 将 会 看 到 ,对 于 连续 型 随机 变量 ,还 可 用 概率 分 布 的 导数 , 即 概率 密度 函数 
来 描述 。 

2. 离散 型 随机 变量 的 概率 分 布 

如 果 随 机 变量 X 只 能 取 有 限 个 或 可 数 个 离散 的 数值 z1 ,zs，… ,zx,，,…, 则 称 X 
为 离散 型 随机 变量 。 若 记 P{X = r) = pG = 1,2,…), 则 义 取 值 的 概率 分 布 由 
(p) 完全 确定 , 称 (pi) 为 X 的 概率 分 布 列 。 分 布 列 一 般 用 如 下 的 列表 形式 给 定 








离散 型 随机 变量 X 的 分 布 函数 为 
Fez) = Dp (2.1.7) 
x< 
概率 分 布 函数 呈 阶 路 性 变化 , 见 图 2. 1 。 


下 面 介绍 几 种 常见 的 离散 型 随机 变量 及 其 ， m 
分 布 。 5 a 





1) 二 项 分 布 图 2.1 离散 随机 变量 的 
如 果 每 次 试验 都 只 可 能 有 两 种 结果 ,成 功 或 失 概率 分 布 函 数 


败 , 即 “0? 或 “1”, 而 且 每 次 成 功 和 失败 的 概率 分 别 
FF pMa, 其 中 pp 十 4 二 1, 即 q 二 1 一 p。 这样 ,在 次 试验 中 ,事件 六 结 果 中 有 & 
次 成 功 的 概率 为 
P{X = k) = Cipt (1—p)"™*, (k = 0,1,2,---,n) (2. 1. 8) 
称 尺 服从 以 >, 力 为 参数 的 二 项 分 布 , 记 为 X — B(n,p)。 服从 二 项 分 布 随 机 变量 x 
的 均值 和 方差 为 
E[X] = np 
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D[ X] = np(1— p) 
二 项 分 布 律 在 工程 中 是 常见 的 ,这 种 连续 多 次 的 试验 称 为 伯 努 利 试验 。 
2) 伯 努 利 分 布 
伯 努 利 分 布 就 是 二 1 情况 下 的 二 项 分 布 ,也 称 为 两 点 分 布 ,或 0 一 1 分 布 。 在 
一 次 试验 中 ,事件 A 出 现 的 概率 为 p ,不 出 现 的 概率 为 1 一 p 二 gq, 若 以 8 记事 件 A 出 
现 的 次 数 , 则 仅 取 0,1 二 值 ,相应 的 分 布 列 为 


人 1) 2.1.9) 


gp 
服从 伯 努 利 分 布 随机 变量 X 的 均值 和 方差 为 
ELX] = p 
DEX] =p — p 
3) 泊 松 分 布 
若 随 机 变量 X 可 取 一 切 非 负 整数 值 , 且 其 概率 分 布 律 为 
PIX = k) = À ea, A > Osk = 0,1,2:- (2.1.10) 
则 称 X 服从 参数 为 4 的 泊 松 分 布 。 服 从 泊 松 分 布 随 机 变量 X 的 均值 和 方差 相等 , 即 
E[X] 一， 
DLX] = 


3. 连续 型 随机 变量 的 概率 分 布 
如 果 X 为 连续 型 的 随机 变量 , 则 其 分 布 函数 F(z) 也 是 连续 函数 , 见 图 2. 2。 如 
果 F(z) 是 可 微 的 , 则 其 导数 
fa) = ED (2.1. 11) 
称 为 这 一 随机 变量 的 概率 密度 函数 , 即 随机 变量 X 的 概率 分 布 函数 F (z) 与 其 密度 
函数 f(z) 之 间 的 关系 为 
Fo) = Í fod, (f(z)>0) (2.1.12) 








图 2. 2 连续 随机 变量 的 概率 分 布 函数 
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f(z) 具有 以 下 性 质 : 
(1) yG) Z0; 


D fa = 9FG2 , 





G) Pla < X <b) = FO -FO =) /drs 


(4) | fade = 1 sie RRR REF 1。 
下 面 介绍 几 种 工程 实际 中 常见 的 连续 型 随机 变量 及 其 分 布 。 


1) 均 匀 分 布 
又 称 为 等 概率 分 布 。 若 随机 变量 X 的 概率 密度 函数 为 
SA 
sofie ERESI (2.1.13) 
o ”其 他 
则 称 z 为 服从 [a ,b] 区 间 上 均匀 分 布 的 随机 变量 ,其 概率 密度 曲线 见 图 2. 3。 
服从 均匀 分 布 随机 变量 X 的 均值 和 方差 为 
a+b 
x= S° 
_ G@— ay 
Dix] = > 
2) 正 态 分 布 
又 称 为 高 斯 分 布 , 若 随 机 变量 X 的 概率 密度 函数 为 
f(D = —L cË C > 0, — so < z< oo) (2. 1.14) 





Vro 
则 称 X 为 服从 正 态 分 布 的 随机 变量 , 记 为 X~ NGdoo2), 其 概率 密度 函数 曲线 见 图 2. 4。 





图 2. 3 均匀 分 布 的 概率 密度 曲线 图 2. 4 正 态 分 布 的 概率 密度 曲线 


从 图 2. 4 可 以 看 出 ,概率 密度 曲线 相对 于 工 == jy 是 对 称 的 ;同时 , o 越 大 ,曲线 越 
平坦 ,jy 是 随机 变量 X 的 中 心 值 , o 表示 相对 其 中 心 值 y 的 离散 程度 。 
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可 以 计算 出 XX 在 yy 土 owy 圭 20,p 士 30 区 间 的 取 值 概率 


2 























P{|X z<. = |” == “az = 0. 6827 
TO 
P(| X— pu |< 20) 二 0. 9545 
TO 
‘uta 
P{| X— p |< 30) igg 2 a= 0.9973 
TO 


3c 的 概率 在 工程 实际 中 有 很 重要 的 意义 ,如 在 进行 数据 处 理 时 , 常 将 3c 作为 野 
值 剔 除 的 门限 。 对 于 正 态 分 布 的 随机 变量 X, 相对 于 均值 y 而 言 ,有 99. 73% 的 把 握 
说 它 不 会 超出 3c。 
服从 正 态 分 布 随机 变量 X 的 均值 和 方差 为 
E[X]= 
D[X]= # 
3) 指 数 分 布 
若 随 机 变量 X 的 概率 密度 函数 为 
Me ， 工 志 0 
fa) = 1 (2. 1. 15) 
则 称 X 服从 指数 分 布 的 随机 变量 ,其 概率 密度 函数 曲线 见 图 2. 5。 
服从 指数 分 布 随机 变量 X 的 均值 和 方差 为 


EL[X] =1 
D[X] 一 去 
4) 瑞 利 分 布 

车 随机 变量 X 的 概率 密度 函数 为 


(2. 1. 16) 
z<0 





O o 


0 x z 
图 2. 5 指数 分 布 的 概率 密度 曲线 图 2. 6 瑞 利 分 布 的 概率 密度 曲线 
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服从 瑞 利 分 布 随机 变量 X 的 均值 和 方差 为 
E[X] = Bo 


D[x] = (4 pE 


2.1.3 随机 变量 的 数字 特征 


如 果 已 知 一 个 随机 变量 X 的 概率 密度 函数 f(x), 则 可 以 计算 它 的 数字 特征 ,用 以 
对 随机 变量 进行 描述 。 对 于 随机 变量 ,常用 的 数字 特征 有 数学 期 望 ,方差 和 协 方差。 

1. 随机 变量 的 数学 期 记 
数学 期 望 又 称 为 均值 。 对 于 连续 随机 变量 X, 其 数学 期 望 定义 为 

EW = |" zf (0)dr = mx (2.1.17) 
对 于 离散 随机 变量 ,其 数学 期 望 定义 为 

ECO = Dips (2.1.18) 
1 


= 
式 中 , p 是 X 取 值 为 zx 的 概率 。 式 (2. 1. 18) 表 示 ,离散 随机 变量 的 数学 期 望 等 于 其 
所 有 可 能 的 取 值 以 其 相应 概率 作为 权 值 的 加 权 和 。 

从 概率 意义 上 讲 ,数学 期 望 是 随机 变量 所 有 可 能 取 值 的 中 心 值 ,相当 于 物体 的 
质心 ,可 看 做 算术 平均 在 概率 空间 上 的 推广 。 如 果 将 X 的 每 一 次 实现 看 做 一 次 观 
测 , 则 X 的 数学 期 望 就 是 平均 观测 , 即 当 观测 次 数 趋 于 无 穷 时 的 极限 值 。 

随机 变量 的 数学 期 望 具有 如 下 特性 : 

(1) 非 随机 变量 C 的 数学 期 望 等 于 其 本 身 , 即 

EO = C 
〈2) 非 随机 的 乘 数 a 可 以 移 到 数学 期 望 的 符号 之 外 , 即 
E(aX) = aE(X) 
(3) 两 个 随机 变量 之 和 的 数学 期 望 等 于 二 者 数学 期 望 之 和 , 即 
E(X +Y) = E(X) +E(Y) 
《4) 两 个 相互 独立 随机 变量 乘积 的 数学 期 望 等 于 各 自 数 学 期 望 的 乘积 , 即 
E(XY) = E(X)E(Y) 

数学 期 望 只 是 从 统计 平均 的 意义 上 描述 了 随机 变量 ,为 了 对 随机 变量 进行 更 好 
的 描述 ,类 似 于 物体 的 转动 惯量 ,还 需要 了 解 随机 变量 的 方差 等 概念 。 

2. 随机 变量 的 方差 

连续 随机 变量 X 的 方差 定义 为 


D(X) = E[(X —mx)°] = (z —mx)° f(z)dë£ (2. 1. 19) 
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对 于 离散 随机 变量 X, 其 方差 的 计算 公式 为 


D(X) = >) Ga —mx)2 p (2. 1. 20) 


= 


随机 变量 的 方差 用 于 描述 随机 变量 相对 于 其 数学 期 望 的 平均 离散 程度 。 由 方 
差 的 定义 可 见 ,如 果 随 机 变量 的 可 能 取 值 偏离 其 数学 期 望 越 大 , 则 其 方差 越 大 ; 反 
之 ,如 果 随机 变量 的 可 能 取 值 越 接近 其 数学 期 望 , 则 其 方差 越 小 。 在 实际 的 测量 或 
估计 问题 中 ,常用 方差 刻画 精度 ,因此 追求 的 目标 是 方差 尽 可 能 小 。 
随机 变量 方差 的 量 纲 是 其 物理 量 纲 的 平方 。 为 了 统一 量 纲 , 通 常 采用 其 平方 
根 , 即 随机 变量 的 标准 差 ,或 称 均 方 偏差 (RMS) ,常用 ox 表示 
ox = VDK) (2.1.21) 
随机 变量 的 方差 具有 如 下 特性 : 
《1) 非 随机 变量 C 的 方差 等 于 0, 即 
DKO) =0 
(2) 非 随机 变量 C 与 随机 变量 X 乘积 的 方差 等 于 C 的 平方 与 X 方差 的 乘积 , 即 
D(CX) = C2DCX) 
(3) 两 个 相互 独立 随机 变量 X 和 Y 之 和 的 方差 等 于 各 自 方差 之 和 , 即 
D(X +Y) = D(X) 十 DC 
方差 描述 了 同一 个 随机 变量 的 统计 特性 ,对 于 两 个 不 同 的 随机 变量 X A Y, 类 
似 于 方差 的 概念 ,可 以 用 协 方差 描述 二 者 之 间 的 关系 。 
3. 随机 变量 间 的 协 方差 ,相关 系数 
为 了 方便 后 面 讨论 相关 系数 ,这 里 首先 给 出 随机 变量 间 相互 独立 的 定义 。 
设 F(z,y) 是 二 维 随机 变量 (X, Y) 的 分 布 函 数 , F(z) 是 X 的 分 布 函数 ，FCy) 
是 Y 的 分 布 函数 。 若 对 任意 实数 z、y, 均 有 
F(z,y) = F(z)F(Yy) (2. 1, 22) 
则 称 X.Y 相互 独立 。 此 定义 可 推广 到 ”个 随机 变量 的 情况 。 
连续 随机 变量 X、Y 之 间 的 协 方差 定义 为 


Cov(X,Y) = EL[(X —EX)(Y — EY)] (2.1.23) 

对 于 离散 随机 变量 XY, 其 协 方差 的 计算 公式 为 
Cov(X,Y) = DG — me) pr Cn — my) py (2. 1.24) 

£ 
称 
Cov( X.Y) 

一 ——— 2 1.25 
Pa DX /DY Ceum 


为 随机 变量 XY 之 间 的 相关 系数 。 
协 方差 的 性 质 如 下 : 
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(1) Cov(X,Y) = Cov(Y,X) ; 

(2) Cov(X,Y) = E(XY) — E(X)E(Y) ; 

(3) D(X +Y) = D(X) + D(Y) +2Cov( X,Y) ; 

(4) Cov(aX ,bY) = abCov( X,Y) ; 

(5) Cov(X; + X; ,Y) = Cov(Xi ,Y) +Cov(X2,Y) ; 

(6) [Cov(X, D1 = D(X)IDOY) 

相关 系数 的 性 质 如 下 ， 

D) lovyl<1; 

DF X 1 Y HEWL py = 0; 

(3) |ow|=11 的 充 要 条 件 是 和 与 了 以 概率 1 REEK , ERM a Ab ,使 下 
式 依 概率 1 成 立 





Y = aX +b 

相关 系数 是 随机 变量 间 线 性 关系 强 弱 的 一 个 度量 。 当 lo, | = 1 时 , 表明 随机 
变量 X 与 了 完全 相关 , 上 且 具 有 线性 关系 ,可 以 认为 二 者 是 相当 (等 价 ) 的 ; 当 
|ou|<<1 时 ,二 者 之 间 的 相关 程度 随 着 | pxv | 的 减 小 而 减弱 ; 当 |p, | = 0 时 ,意味 
着 二 者 完全 不 相关 。 

虽然 两 个 相互 独立 的 随机 变量 一 定 是 不 相关 的 ,但 是 两 个 不 相关 的 随机 变量 却 
未 必 相互 独立 。 相 关 性 是 指 两 个 随机 变量 之 间 的 线性 关系 ,如 果 两 个 随机 变量 独 
立 , 就 是 说 它们 之 间 没 有 任何 关系 ,自然 也 不 会 有 线性 关系 ,所 以 它们 不 相关 。 但 
“不 相关 ”只 是 说 明 它 们 之 间 不 具有 线性 关系 ,但 是 可 以 有 别 的 关系 ,所 以 不 一 定 相 
互 独立 。 也 就 是 说 ,独立 一 定 不 相关 ,而 不 相关 不 一 定 独立 , 即 

XX 与 了 相互 独立 之 X 与 Y 不 相关 Sp, = 0 

例如 , 设 Z 服 从 [一 ,x] 上 的 均匀 分 布 ,又 X= sinZ,Y = cosZ。 可 求 得 oo = 0, 
即 随机 变量 X 与 立 不 相关 ,但 由 于 X: +Y = 1, 因此 XX 与 Y 不 独立 。 

4. 随机 变量 的 给 


在 描述 随机 变量 时 ,有 了 时 为 了 描述 得 更 准确 ,不 仅 需要 均值 .方差 . 协 方差 等 参 
数 , 还 需要 更 高 阶 数 的 参数 ,这 就 是 随机 变量 的 矩 。 设 X 与 了 是 随机 变量 

DE EX) ,k = 1,2,… 存在 , 则 称 它 为 X HY k 阶 原点 矩 ,简称 上 阶 矩 ; 

DE EXE) F), k = 1,2, 存在 , 则 称 它 为 的 & 阶 中 心 矩 ; 

OF EXY’) k,l = 1,2,… 存在 , 则 称 它 为 XX 与 Y 的 十 1 阶 混合 矩 ; 

(4) 若 E{[X 一 ECX)J][Y -EVF ),k, = 1,2, 存在 , 则 称 它 为 X 与 Y 的 k 
十 ! 阶 混合 中 心 矩 。 

显然 , X 的 数学 期 望 已 (X) 是 和 的 一 阶 原点 矩 ,方差 D(X) 是 和 的 二 阶 中 心 矩 ， 
协 方差 Cov(X,Y) E: X 与 了 的 二 阶 混合 中 心 矩 。 
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2.1.4 随机 变量 的 极限 定理 


概率 论 与 数理 统计 是 研究 随机 现象 统计 规律 的 学 科 , 而 随机 现象 的 规律 只 有 在 
相同 的 条 件 下 进行 大 量 重复 试验 时 才 会 呈现 出 来 。 也 就 是 说 ,要 从 随机 现象 中 寻求 
事件 发 生 的 规律 ,需要 研究 大 量 的 随机 现象 ,这 常常 通过 采用 极限 的 形式 ,由 此 需要 
对 极限 定理 进行 研究 。 极 限定 理 的 内 容 很 广泛 ,其 中 比较 重要 的 有 两 个 :大 数 定律 
与 中 心 极限 定理 。 

1. 大 数 定律 

众所周知 ,频率 是 概率 的 反映 , 即 随 着 观察 次 数 n 的 增 大 ,频率 将 逐渐 稳定 到 概 
率 ,而 且 当 nn 很 大 时 ,频率 与 概率 非常 接近 。 这 里 说 的 “逐渐 稳定 "和 “非常 接近 ”都 只 
是 一 种 直观 的 说 法 ,其 严格 的 数学 意义 需要 进一步 闹 明 ,这 就 是 大 数 定律 所 表述 的 


内 容 。 

# Xi ,Xs，,… 是 随机 变量 序列 ,如 果 存 在 常数 列 a ,as,…, 使 得 对 任意 的 se 之 0, 有 
imp |+ % | < =1 (2.1.26) 
=] 

成 立 , 则 称 随机 序列 (Xn) 服从 大 数 定律 。 

下 面 介绍 两 个 常用 的 大 数 定律 。 


《1) 伯 努 利 大 数 定律 。 设 wm 是 ?次 独立 试验 中 事件 A 出 现 的 次 数 ,而 p(0 < 
p < 1) 是 事件 A 在 每 次 试验 中 出 现 的 概率 , 则 对 任意 的 e > 0, 有 


timp[ -pl<e] -1 (2.432275 
此 定律 表明 ， 当 试验 次 数 很 大 时 ,事件 A 出 现 的 频率 呈现 出 稳定 性 ,逐渐 稳定 
于 某 个 常数 , 即 事件 A 的 概率 。 这 时 ,可 以 用 事件 发 生 的 频率 代替 事件 的 概率 。 


(2) 辛 钦 大 数 定律 。 设 Xi ,Xs，… 是 相互 独立 同 分 布 的 随机 变量 序列 , 且 存在 有 
限 且 相同 的 数学 期 望 (u = EX, ,n = 1,2,… ), 则 对 任意 的 e 二 0, 有 


im 中 Dx a| <] =1 (2. 1. 28) 
w... k=1 


此 定律 表明 , 当 试 验 次 数 很 大 时 ,独立 同 分 布 的 随机 变量 的 平均 值 依 概率 收敛 
于 它 的 数学 期 望 。 辛 钦 大 数 定律 不 要 求 随机 变量 的 方差 存在 ,所 以 其 应 用 比 伯 努 利 
大 数 定律 更 广泛 。 


2. 中 心 极限 定律 


中 心 极限 定理 是 讨论 随机 变量 序列 部 分 和 的 分 布 渐 近 于 正 态 分 布 的 一 类 定理 ， 
是 概率 论 中 比较 重要 的 一 类 定理 ,有 广泛 的 实际 应 用 背景 。 在 自然 界 与 生产 中 ,一 
些 现象 受到 许多 相互 独立 的 随机 因素 的 影响 ,如 果 每 个 因素 所 产生 的 影响 都 很 微小 
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时 ,总 的 影响 可 以 看 作 是 服从 正 态 分 布 的 。 中 心 极限 定理 就 是 从 数学 上 证 明了 这 一 
现象 。 

设 (X,) 为 相互 独立 的 随机 变量 序列 ,存在 有 限 的 数学 期 望 和 方差 : EX) = 
u D(X,) = h,k = 1,2,---, ÆR} z € ET 


Etade (2.1.29) 
= 一 


limP(m < <z)= 
则 称 (Xn) 服从 中 心 极限 定理 。 其 中 ， 
= SEX) 


r=- 
[IDX 
km) 

称 为 (X,) 的 规范 和 。 


下 面 介绍 两 个 常用 的 中 心 极限 定理 。 
(1) 棣 莫 佛 一 拉 普 拉 斯 中 心 极限 定理 。 设 p, 表 示 次 伯 努 利 试验 中 事件 A 出 现 
的 次 数 ,每 次 试验 中 A 出 现 的 概率 为 p(0 < p < 1), AEN z€ R, 有 


limPp| ”eid (2. 1.30) 


P g 
Z <=] 32 Vn) 


显然 ,ou = Èx 其 中 Xa ,Xs，,… BIS BC, p) 


此 定理 是 最 初 的 中 心 极限 定理 ,讨论 了 服从 二 项 分 布 的 随机 变量 序列 。 它 指 
出 , 当 w 充 分 大 时 ,参数 为 ,pp 的 二 项 分 布 以 np 为 均值 、 np Q — p) 为 方差 的 正 态 分 
布 为 极限 。 

(2) 林 德 伯 格 一 列 维 定理 。 设 Xi , Xs ,… 独立 同 分 布 , 且 具 有 相同 的 数学 期 望 和 
方差 : EX.) = u, D(X,) 一 到 ,一 1,2,…, 则 对 任意 的 x E R, 有 


a 
<d- dz (2.1.31) 


此 定理 是 标 莫 佛 - 拉 普 拉 斯 中 心 极限 定理 的 扩展 , 它 讨 论 独立 同 分 布 随机 变量 序 
列 的 中 心 极限 定理 。 它 表明 ,独立 同 分 布 且 数 学 期 望 和 方差 有 限 的 随机 变量 序列 的 
标准 化 和 以 标准 正 态 分 布 为 极限 。 


2.1.5 随机 向 量 及 其 数字 特征 


?个 随机 变量 Xi Xoe X, 的 总 体 构 成 一 个 za 维 向 量 = (Xi, Xass Xp), 
称 为 n 维 随机 向 量 ,或 nn 维 随机 变量 。 


ny 
tar [ži re 
n vno 
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1. 随机 向 量 的 分 布 函数 
E (zz，…'zno) FE n EKRE R" 中 的 一 点 , 则 X, S z , X, < z=x , =, X, < 
=, 的 概率 
F(zi,T2 °°, Tn) = P(X, < x, X; S T250 X, < Tn) (2. 1. 32) 
作为 五 ,zz，…zs 的 函数 , 称 为 随机 向 量 X = (X. , X250 XT BJ n 维 分 布 函 数 。 
特别 地 , 当 交 一 2 时 
F(x,y) = P(X < xr,Y < y) (2. 1. 33) 
称 为 (X,Y) KAE RA EER X 1; Y 的 联合 分 布 函数 。 
联合 分 布 函 数 具 有 如 下 基本 性 质 : 
对 于 (zi,y1),《T2oyyz) € Rè, WMR 2 < z+ B. > < y WJ 
P(zi < X< zx;>x < Y < y} 
=F(axs, ya) — Flai y2) — Flay) + F(zi y) 
多 维 随 机 变量 的 研究 方法 与 一 维 随机 变量 类 似 , 也 可 用 概率 密度 、 数 学 期 望 . 方 
差 和 和 矩 等 描述 其 统计 规律 。 
2. 随机 向 量 的 数学 期 望 
如 果 ELX,]JG = 1,2,…,n) 存在 , 则 随机 向 量 X 的 数学 期 望 可 写 为 
EC(X) = [E(X.),E(X,),---, EC(X,) Tt (2. 1. 35) 
前 面 关于 标量 随机 变量 数学 期 望 的 特性 同样 适用 于 随机 向 量 的 情况 。 
在 有 些 试验 中 ,需要 研究 的 随机 变量 X 往往 无 法 直接 测量 ,只 能 通过 与 之 相关 
的 另 一 随机 变量 Y 间接 得 到 测量 。 在 这 种 情况 下 ,由 Y 的 测量 数据 推算 得 随机 变量 
X 的 数学 期 望 称 为 条 件数 学 期 望 。 条 件数 学 期 望 也 是 在 本 书后 续 章 节 中 经 常 涉及 
的 一 个 概念 。 
假定 Z 是 随机 变量 X 的 函数 Z = p(X),X 和 2 是 需要 研究 的 对 象 ,假定 已 知 随 
WER Y RIFF X 的 条 件 概率 为 f Ca: | y), 则 根据 随机 变量 X 可 能 取 值 z 的 范围 ， 
可 以 计算 随机 变量 Z 的 条 件数 学 期 望 , 即 


Ex[Z |Y = y) = |” çG ez | yde (2.1.38) 


条 件数 学 期 望 和 无 条 件数 学 期 望 之 间 有 下 列 关系 
Er{ExLZ | Y = Y(-)]} = Ex[Z] 
上 式 表明 ,如 果 对 应 于 随机 变量 Y 的 每 一 次 实现 ,可 算出 随机 变量 Z 的 条 件数 
学 期 望 ,那么 对 随机 变量 Y 所 有 可 能 的 取 值 ( 即 实现 ) ,可 计算 随机 变量 Z 的 无 条 件 
数学 期 望 。 
在 研究 随机 变量 的 估计 值 时 ,条 件数 学 期 望 具有 重要 的 意义 。 通 常 采用 条 件数 
学 期 望 值 作 为 随机 变量 的 估计 值 , 即 


(2. 1. 34) 
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Ñ = Ex[X | Y =Y(.)] (2.1.37) 
式 中 , YO) 是 试验 中 可 直接 观测 的 随机 变量 。 
3. 随机 向 量 的 协 方差 
定义 随机 向 量 任意 两 个 变量 X, 和 X; 的 协 方差 为 
b; = Cov(X,,X,) = E([X,— ECX)I[X;—ECX)] (2.1.38) 
特别 地 , 当 守 一 7 时 
bi = E([X, — EXD JLX: 一 ECXD)]) = D(X) (2. 1. 39) 
协 方差 表示 两 个 随机 变量 之 间 相 互联 系 的 程度 。 如 果 两 个 随机 变量 互相 独立 ， 
那么 它们 的 协 方差 一 定 等 于 0, 但 反之 未 必 成 立 。 如 果 两 个 随机 变量 的 协 方差 为 0， 
称 它们 为 互 不 相关 。 
两 个 随机 变量 X, MX, 之 间 的 协 方差 具有 以 下 特性 : 
(1) Cov(X;, X;) = Cov(X,,X,) ; 
(2) Cov(X,, X;) < /D(X)DGOX;) 。 
对 于 两 个 随机 向 量 XV = [X X25 X.] MY" = [Yi YY] 定义 它们 的 
协 方差 矩阵 为 




















bu bu e bun 
bx +e bon 
p= |P Pa 8 (2. 1.40) 


ba ba … b, 
其 中 , by = Cov(Xi ,Zi)。 当 天 一 时 ,上 述 矩阵 称 为 自 相 关 和 矩阵 。 


2.2 随机 过 程 


2.2.1 随机 过 程 的 概念 和 特性 


1. 随机 过 程 的 概念 

从 前 面 的 学 习 可 知 ,随机 试验 所 有 的 可 能 结果 可 以 用 随机 变量 的 取 值 来 表示 。 
有 时 ,随机 变量 会 随 着 某 些 参 数 变 化 ,或 者 说 是 某 些 参 数 的 函数 。 例 如 ,大 气 的 温度 
和 压力 是 随 着 时 间或 高 度 变化 的 ,信道 上 传输 的 音频 信号 也 是 随时 间 变 化 的 随机 
信号 。 

工程 实际 中 的 随机 变量 往往 是 以 时 间 z 作为 参 变量 的 随机 函数 X(t,w), 这 样 的 
随机 函数 称 为 随机 过 程 。 电 子 设备 中 ,电阻 上 的 噪声 电压 是 典型 的 随机 过 程 ,如 
图 2.7 所 示 。 其 中 ,每 一 条 曲线 代表 一 个 电压 波形 。 所 有 这 些 波形 的 集合 就 是 随机 
过 程 。 
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t 
图 2. 7 随机 过 程 的 各 次 实现 


正如 随机 变量 X(w) 的 一 次 实现 是 确定 的 数值 一 样 ,随机 过 程 X(t,w) 的 一 次 具 
WER XG), MH w= w Rt, X(t,wo) 是 时 间 t 的 一 个 确定 函数 。 如 果 进 行 多 次 
长 时 间 的 实验 , 即 o 取 wi,ws，…,w, 时 , 便 得 到 随机 过 程 的 多 次 实现 。 显然, 这些 
X(t,wi) 的 曲线 是 不 会 重合 的 。 

当 4 取 固定 的 时 间 ,to，,…,t 时 ,在 每 一 个 时 间 截 面 上 一 z, 随机 过 程 取 不 同 的 
ME XC sw) X Crw) X Uro), 这 相当 于 一 个 & 维 的 随机 变量 。 因 此 ,随机 过 程 
相当 于 一 个 多 维 的 随机 变量 。 对 于 随机 过 程 的 讨论 ,可 以 采用 前 面 介 绍 的 多 维 概率 
分 布 函数 描述 其 统计 特性 。 例 如 ,将 两 个 时 间 截 面 的 随机 变量 看 做 是 一 个 二 维 的 随 
机 变量 系统 ,用 它们 之 间 的 联合 概率 分 布 函数 描述 它们 的 统计 特性 。 为 了 全 面 描述 
随机 过 程 的 统计 特性 ,需要 引信 n 维 随机 变量 之 间 的 联合 概率 分 布 函 数 。 

可 以 对 随机 过 程 描述 如 下 : 

(1) 随 机 过 程 X(t,w) 是 非 随 机 自 变量 : 的 一 个 函数 ,在 每 个 时 间 截 面 5 E, 
XG o) 是 一 个 随机 变量 。 为 简便 起 见 ,随机 过 程 简写 为 XG). 

(2) 随 机 过 程 的 截面 X(t) 是 对 应 于 自 变量 取 值 的 随机 变量 。 

(3) 随 机 过 程 XO 的 一 次 实现 是 自 变量 ¿ 的 确定 函数 ,是 在 一 次 测试 中 得 到 的 
实验 曲线 。 

因此 ,随机 过 程 可 以 看 做 是 与 时 间 :有 关 的 多 维 随机 变量 集合 ,也 可 以 看 做 是 所 
有 实现 的 一 个 集合 。 

综 上 ,下 面 用 数学 语言 给 出 随机 过 程 的 定义 :给 定 随机 试验 的 样本 空间 Q = 
{w) ,对 于 空间 的 每 一 个 样本 o, € Q, 总 有 一 个 时 间 函 数 XG.) 与 之 对 应 。 其 中 ， 
t ET, 丁 为 固定 的 时 间 区 间 。 对 于 空间 的 所 有 样本 w € Q, 有 一 族 时 间 函 数 X(t,w) 
与 之 对 应 ,这 族 时 间 函 数 称 为 随机 过 程 。 随 机 过 程 的 值 域 E 称 为 它 的 相 空 间 ( 或 状 
态 空间 ) ,而 正中 的 元 素 称 为 状态 。 
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在 图 2. 7 中 ,如 果 取 固定 的 时 刻 , 则 得 到 一 个 随机 变量 。 这 个 随机 变量 是 连续 还 
是 离散 决定 了 这 个 随机 过 程 是 连续 随机 过 程 还 是 离散 随机 过 程 。 随 机 过 程 如 果 在 
时 间 轴 上 是 等 间隔 间断 的 , 且 在 任意 时 刻 上 其 随机 变量 是 连续 的 , 称 为 连续 随机 序 
列 ;如 果 在 任意 离散 时 刻 随机 变量 是 离散 的 , 则 称 其 为 离散 随机 序列 。 

随机 过 程 可 以 是 标量 的 X(#), 也 可 以 是 向 量 的 ,写作 [X(t), Xz O), e 
Xz)]"。 这 种 随机 过 程 称 为 随机 向 量 过 程 。 

2. 随机 过 程 的 特征 

前 面 讲 到 ,随机 变量 的 局 部 特征 包括 它 的 均值 ,方差 和 和 矩 等 。 类 似 地 ,也 可 以 使 
用 均值 .方差 和 矩 等 局 部 特征 来 描述 随机 过 程 。 随 机 过 程 的 上 述 局 部 特征 一 般 来 说 
是 时 间 的 函数 。 对 于 随机 过 程 ,还 需要 一 些 新 的 特征 来 描述 ,包括 ” 阶 概率 密度 、 自 
相关 函数 和 功率 谱 密度 等 。 这 些 特征 能 够 给 出 不 同 随机 过 程 所 具有 的 不 同 信息 。 

17 随 机 过 程 的 n 阶 概率 密度 

如 上 所 述 , 随 机 过 程 在 时 间 区 间 上 的 任 一 时 刻 表 现 为 一 个 随机 变量 。 如 果 在 随 


机 过 程 的 定义 区 间 T HERAF n DA t , 刀 ，…z， 则 对 于 确定 的 时 刻 t; € T, 
XG) 是 一 个 随机 变量 。 对 于 所 有 的 CG = 1,2,…,n)， 得 到 维 随机 变量 (X), 
X(to),…，X(t,)}。 若 nn 足够 大 ,所 取 的 间隔 充分 小 , 则 可 以 用 维 随机 变量 近似 表 


示 一 个 随机 过 程 。 因 此 ,可 以 通过 多 维 随机 变量 的 分 布 律 描述 随机 过 程 的 分 布 律 ， 
进而 用 随机 变量 的 数字 特征 描述 随机 过 程 的 数字 特征 。 
随机 过 程 XO BJ n 维 联合 概率 分 布 函 数 定义 为 
Fx (TisTe z asti to s t,) = P(X(ti) S< =u, X(ts) S res X (tn) < Ta} 
A (2. 2, 1) 
式 (2. 2. 1) 表 示 随 机 过 程 XCz) 在 不 同时 刻 取 值 XG.) 小 于 z, 的 概率 。 


车 Fx(azyza zabit tt.) 对 zi ze tz, 的 偏 导数 存在 , 则 称 
fr rt tant) = VEe? CQ. 2.2) 








H XG) 的 nn 阶 概率 密度 函数 。 

当 n = 1, 即时 间 固 定时 ,随机 过 程 X(z) 退化 为 一 个 一 维 的 随机 变量 X(t) 可 
以 定义 其 一 维 概率 分 布 函 数 和 一 阶 概率 密度 函数 。 

对 于 任意 两 个 时 刻 和 如, 可 以 确定 随机 变量 XG) = X, AX) 二 Xo，, 或 者 说 一 
个 二 维 随机 变量 (X, ,X,) 可 以 定义 为 随机 过 程 的 二 维 概率 分 布 函数 Fx C sT yh yta) 和 
二 阶 概率 密度 函数 fx(zi z h t) 。 一 般 来 说 ,随机 变量 X, 和 X, 不 是 相互 独立 的 , 因 
此 不 能 仅 由 一 阶 密度 函数 确定 二 阶 密度 。 对 于 其 他 时 间 对 ,情况 类 似 。 因 此 ,只 有 知道 了 
所 有 时 间 对 的 联合 密度 , 才 可 能 确定 一 个 随机 过 程 的 二 阶 密度 。 

随机 过 程 分 布 律 的 性 质 可 由 随机 变量 分 布 律 的 性 质 得 到 。 若 两 个 随机 过 程 
X(t) 和 Y(z) 相互 独立 , 则 二 者 的 联合 密度 为 
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Slayt t) = fx(z,t) fryt) . (2. 2. 3) 

值得 注意 的 是 ,两 个 随机 过 程 相互 独立 与 一 个 随机 过 程 在 不 同时 刻 互 相 独 立 在 
概念 上 是 不 同 的 。 

对 于 随机 过 程 XG) , 如 果 式 (2. 2. DRAC. 2. 2) 已 知 , 则 该 随机 过 程 定义 为 完 
全 的 或 具有 全 局 统计 特征 。 但 是 一 般 来 说 ,要 想得到 一 个 随机 过 程 的 多 维 分 布 律 是 
很 困难 的 ,而 且 有 时 利用 局 部 特征 足以 根据 给 定 的 输入 特征 而 得 到 相应 的 输出 特 
征 ,为 此 需要 定义 随机 过 程 不 同 的 局 部 特征 , 即 数字 特征 :均值 ,方差 , 协 方差 及 功率 
谱 密度 等 。 

随机 过 程 “数字 特征 ”的 概念 可 由 随机 变量 的 数字 特征 推广 而 来 。 不 同 的 是 , 随 
机 过 程 的 数字 特征 不 再 是 确定 的 值 ,而 是 关于 时 间 的 函数 。 

2) 随 机 过 程 的 数学 期 望 

对 于 任意 时 刻 的 i, 随机 过 程 XG) 是 一 个 随机 变量 X), 随机 变量 X(t1) 的 
数学 期 望 就 是 随机 过 程 X(z) E n 时 刻 的 数学 期 望 。 对 于 不 同 的 ;, 随机 过 程 的 数学 
期 望 是 一 个 确定 的 时 间 函 数 , 记 为 ELX(D] sÀ mx (z) , BB 


mx) 一 | zfxCe, ax 2.2.4) 


其 中 ， fx(z,t) 为 X(z) 已 知 的 一 维 概率 密度 函数 。 
随机 过 程 XO 的 数学 期 望 m< (a) 见 图 2. 8, 是 多 次 实现 的 统计 平均 ,随时 间 的 
增长 可 能 会 有 缓慢 的 变化 





图 2.8 随机 过 程 的 数学 期 望 与 方差 


随机 过 程 的 数学 期 望 具有 如 下 特性 : 
《1) 确 定性 时 间 函 数 g(z) 的 数学 期 望 等 于 它 本 身 , 即 
E[g(t)] = g0) 
(2) 两 个 随机 过 程 之 和 的 数学 期 望 等 于 二 者 数学 期 望 之 和 , 即 
E[XG) HY] = mxG) +my(t) 
HYO 是 确定 性 函数 时 ,结论 也 成 立 。 上 述 情况 可 以 推广 到 个 随机 过 程 的 情况 。 
(3) 随 机 过 程 XO 与 确定 性 函数 plz) 之 积 的 数学 期 望 如 下 ， 
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ELp(DX(D] = opCDELX(CD] = pmx (t) 
类 似 于 随机 变量 的 条 件 期 望 ,可 以 定义 随机 过 程 的 条 件 期 望 。 


3) 随 机 过 程 的 方差 
随机 过 程 XO 的 方差 也 是 时 间 的 函数 , 记 为 Dx(z) sk ok (O) , 即 
DxW = |` [ze—m OF fxd (2.2.5) 


方差 Dx(z) 描述 的 是 随机 过 程 X(z) 的 所 有 样本 函数 相对 数学 期 望 mx G) 的 离 
散 程 度 。 其 中 ,离散 程度 不 仅 与 X(z) 所 有 取 值 中 的 最 大 值 和 最 小 值 有 关 , 而且 还 与 
取 值 偏离 数学 期 望 的 密度 有 关 。 在 图 2. 8 中 , 粗 实 线 表示 mx (t) 十 ox(2) 和 wax(D 一 
ax (t), 其 中 , ox G) 一 VAO 称 为 均 方差 或 标准 差 。 

随机 过 程 的 方差 具有 如 下 特性 : 

〈1) 确 定性 时 间 函 数 p(t) 的 方差 等 于 0, 即 

Dlg] =0 
(2) 随 机 过 程 X(t) 与 确定 性 函数 p(t) 之 和 的 方差 等 于 随机 过 程 自身 的 方差 , 即 
E[XG) + p(t)] = Dx) 

OMINIE XO 与 确定 性 函数 pe) 之 积 的 方差 等 于 确定 性 函数 的 平方 乘 以 

该 随机 过 程 的 方差 , 即 
E[g(D) 。X(D] = gDx Ce) 

上 述 情况 可 以 推广 到 =” 个 随机 过 程 的 情况 。 

4) 随 机 过 程 的 相关 函数 

对 于 两 个 不 同 的 随机 过 程 X(t) MYA, 它们 的 数学 期 望 和 方差 随时 间 的 变化 
相同 并 不 等 于 这 个 随机 过 程 的 统计 属性 相同 。 图 2. 9 就 说 明了 这 种 情况 。 这 里 ,两 
个 随机 过 程 的 期 望 和 方差 是 相同 的 ,但 各 自在 不 同时 刻 中 变量 值 的 相关 和 矩 是 不 同 
的 。 相 关 矩 随时 间 而 变化 的 这 个 函数 称 为 随机 过 程 的 相关 函数 。 如 果 XCt) 和 Y(t) 
相等 , 则 相关 函数 称 为 自 相关 函数 。 自 相关 函数 表明 一 个 随机 过 程 在 两 个 不 同时 刻 
之 间 的 关联 程度 。 否 则 , 称 为 互相 关 函 数 。 





图 2. 9 具有 不 同 相关 函数 的 两 个 随机 过 程 
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对 于 任意 两 个 时 刻 拉 和 zs;，, 随机 过 程 XG) 的 自 相 关 需 数 定义 为 
Roax hst) = EXX] = |_| zz feCa main sth) driz 
(2.2.6) 

RO. 2. 6) 实 际 是 XO 在 两 个 时 刻 和 如 的 状态 XG) XG) 的 二 阶 混合 原 
点 矩 。 它 描述 的 随机 起 伏 不 仅 有 快慢 的 变化 ,还 有 其 幅度 的 变化 。 

与 随机 过 程 的 数学 期 望 和 方差 不 同 的 是 ,相关 函数 Rx (ti ,to) 是 两 个 时 间 变 量 
“t A t RR, ERRERA RTE t 和 所 上 ,两 个 随机 变量 XCGa) M XG) 的 互 
相关 程度 。 在 图 2. 9 中 ,两 个 随机 过 程 具 有 相同 的 均值 和 方差 ,但 左边 曲线 表示 相关 
函数 Rx (ti ,tz) 的 振幅 较 小 , 即 随机 过 程 X(2) 的 变化 较 快 ,在 相 邻 的 两 个 时 间 截 面 
h Hit P, XG) 取 值 很 少 相关 。 右 侧 的 曲线 与 之 相反 。 

描述 随机 过 程 的 男 一 个 扼 函 数 是 二 阶 混合 中 心 矩 , 称 为 协 方差 函 数 , 即 

Cy(n,ta)= E([X(n) —mx(n)J[X() — mx C12)]} 


=[ J Ce — me JEz — mx Ct) frst) dn 


(2. 2.7) 
协 方差 函数 与 自 相关 机 数 不 同 的 是 , 它 描述 的 随机 起 伏 是 相对 数学 期 望 的 幅度 
变化 。 自 相关 函数 Ryl st) 和 协 方差 函数 Cx ,ts) 之 间 的 关系 为 
Cx(ti t2) = Rx (t ,tz) — mx (tı )my (t) (2. 2. 8) 
如 果 在 任意 时 刻 , XG) 的 数学 期 望都 等 于 0, 则 自 相关 函数 和 协 方差 函数 完全 相 
等 。 上 述 两 个 概念 只 相差 一 个 统计 平均 值 , 在 实际 应 用 中 ,二 者 往往 不 加 区 分 地 使 用 。 
协 方差 函数 具有 如 下 性 质 : 
(1) 绝 对 值 不 会 超过 相应 截面 两 个 方差 值 的 几何 平均 数 , 即 
Cxlti,t2) < VDx Ch) Dx ts) (2. 2.9) 
《2) 相 关 函 数 具 有 功率 的 量 纲 。 有 时 ,为 了 消除 量 纲 , 也 为 了 便于 计算 ,将 自 相 
关 函 数 作 如 下 标准 化 处 理 ， 





Cy (ti st) 
VDx) Dx) 
ox (n sta) 称 为 相关 系数 , 它 的 值 在 [一 1,1] 之 间 。 

H i = t if EAH Rxx (i st) = Dx(z), 所 以 自 相关 函数 的 概念 包含 了 方差 的 


px tists) = (2. 2. 10) 


自 相关 函数 的 概念 表达 了 一 个 随机 过 程 在 不 同时 间 截 面 上 取 值 的 相关 性 ,这 一 
概念 也 可 以 推广 到 两 个 不 同 的 随机 过 程 ,以 表示 两 个 随机 过 程 在 不 同时 间 截 面 上 取 
值 的 关联 性 。 这 时 ,两 个 随机 过 程 X(t) 和 YG) 的 相关 函数 称 为 互相 关 函 数 。 

已 知 两 个 随机 过 程 XG) 和 Y(z) 的 联合 概率 密度 , 则 二 者 的 互相 关 函 数 为 
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Rxy (ti st2)= E([XGa) — mx (t) ICY t2) — my (t) ]} 
=|? f? [e-ma ym fry st) drdy 


(2.2.11) 

如 果 对 任意 的 和， 有 Rir Cst) = 0, WE XO 和 Y(z) 是 不 相关 的 。 但 
是 ,应 当 注 意 , 当 X(t) 和 Y(t) 互相 独立 , 即 满足 式 (2. 2.3) 时 , 则 X(z) 和 Y(z) 一 定 
互 不 相关 。 反 之 , 则 不 一 定 成 立 。 

后 面 将 要 介绍 一 类 重要 的 随机 过 程 , 称 为 平稳 随机 过 程 , 自 相关 函数 Re C st) 
可 以 表示 为 时 间 差 一 tz 二 + 的 函数 Rx (z) , 其 自 相关 函数 是 平稳 的 。 这 类 随机 过 
程 有 另 一 种 频 域 表 示 的 特征 , 称 为 功率 谱 密度 。 功 率 谱 密度 在 后 面 介 绍 。 

5) 随 机 过 程 的 高 阶 矩 

在 某 些 情况 下 ,如 在 非 线 性 系统 中 ,或 者 对 于 某 些 过 程 ,可 能 需要 讨论 随机 过 程 
X(z) 的 高 阶 矩 ,如 EL Xu X, X: ELX: X, X X. J A E[ Xi X; ] 等 。 但 是 ,对 于 高 斯 过 
程 , 只 用 均值 和 方差 即 可 描述 其 全 部 统计 特性 。 根 据 大 数 定律 和 中 心 极限 定理 ,在 
实际 应 用 中 ,大 量 的 随机 变量 (过 程 ) 可 近似 看 作 高 斯 分 布 ,因此 可 只 用 其 前 两 阶 矩 
描述 。 由 于 高 斯 分 布 量 通过 线性 系统 后 仍 为 高 斯 分 布 ,因此 在 讨论 系统 的 输入 一 输 
出 特征 时 ,也 可 以 只 讨论 其 前 两 阶 矩 。 


2.2.2 随机 过 程 的 线性 运算 


1. 随机 过 程 相 加 


本 节 介 绍 随机 过 程 经 过 线性 运算 以 后 ,它们 的 数学 期 望 和 相关 函数 应 如 何 计算 。 
假定 随机 过 程 ZG) 是 两 个 随机 过 程 X(t) MYO 之 和 , 则 Z(z) 的 数学 期 望 为 

ELZ] = ELX] + ELY] (2. 2. 12) 
ZG) 的 相关 函数 为 


Rz ,1)= [Że] 
= E([KG@) +YGDJ [XG ) +YG)J) 
= HXi) Ka] + EL XG) YG,)] + EY ) KG) 1+ EY ) Y] 
= Cx (h st) + Ray (tts) +Ryx (t st) +O Ch ste) 





(2. 2. 13) 
其 中 , XO = XG) — E[LX() 1, XO XXO Hy. 

可 以 看 出 , ZG) 的 数学 期 望 等 于 X(z) 和 Y(z) 数学 期 望 之 和 ,而 Z(z) 的 相 函 数 
等 于 X(z) MYO 所 有 自 相关 和 互相 关 函 数 之 和 。 

2. 随机 过 程 的 微分 


在 研究 随机 过 程 的 微分 之 前 ,首先 需要 了 解 随机 过 程 “连续 ”的 概念 。 由 于 随机 
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变量 和 随机 过 程 在 每 一 次 实现 中 取 值 不 同 , 它 的 连续 性 只 能 从 多 次 实现 来 看 , 即 较 
弱 意 义 下 的 “连续 ”。 下 面 从 均 方 意义 下 来 研究 。 
对 于 随机 过 程 X(z), 如 果 满 足 

limE([XG + A) -XOF = 0 (2. 2. 14) 

aro 
即 

limXG+ AD = X0) (2. 2. 15) 

则 称 随机 过 程 X(z) 在 均 方 意义 下 连续 。 其 中 ,lim 表示 均 方 意义 上 的 极限 (limit in 
mean), E 


如 果 在 均 方 意义 上 成 立 , 即 
lmE|([* (+ 0 xO awT) ð 2.2.16) 








则 称 
2P = lim 
为 随机 过 程 XA) 的 微分 。 
如 果 随 机 过 程 的 数学 期 望 和 相关 函数 都 是 可 微 的 , 则 该 随机 过 程 具有 可 微 性 。 
3. 随机 过 程 的 积分 
类 似 于 定义 随机 过 程 微分 的 方法 ,同样 可 以 利用 均 方 极限 来 定义 随机 过 程 的 积 
分 。 假 设 积分 区 间 为 [ae, 拉 ,将 其 分 为 个 小 区 间 ,使 每 个 区 间 Ar, 的 长 度 趋 近 于 0, 若 


3 . a 
limE([Y— BD xean] } =o (2.2.18) 


XG-+ AD 一 和 CD) 
a (2.2.17) 


则 称 
Y= im D XG) At, (2. 2. 19) 


为 随机 过 程 XCz) 在 均 方 意义 下 的 积分 。 此 处 , Y 为 随机 过 程 ,定义 为 随机 过 程 和 式 
的 均 方 极限 。 


2.2.3 平稳 随机 过 程 及 其 功率 谱 密 度 


1. 平稳 随机 过 程 的 定义 和 性 质 

平稳 随机 过 程 是 一 类 重要 的 随机 过 程 ,在 实际 的 工程 领域 中 ,有 很 多 随机 过 程 
是 平稳 的 或 近似 平稳 的 。 如 果 随机 过 程 的 统计 特性 并 不 随时 间 变化 , 则 称 此 过 程 为 
平稳 随机 过 程 。 对 平稳 随机 过 程 的 分 析 要 比 一 般 随 机 过 程 简单 ,因此 研究 平稳 随机 
过 程 不 仅 是 重要 的 ,而 且 也 是 必要 的 。 

定义 2.1 IAE XO 的 维 概率 密度 函数 与 时 间 的 起 点 无 关 , 即 
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fx zis zat Tasty ta stn) = fx (Ti Ta Td 二 Ty 二 Tt 十 TT) 
(2. 2. 20) 
则 称 X(z) 为 严格 意义 上 的 平稳 过 程 ,简称 严 平稳 过 程 ,或 称 狭义 平稳 过 程 。 
研究 严 平稳 过 程 的 意义 是 ,在 任何 时 刻 它 的 统计 特性 都 相同 。 这 给 问题 的 研究 
带 来 极 大 的 方便 。 
在 实际 问题 中 ,利用 随机 过 程 的 概率 密度 判断 严 平稳 性 是 很 困难 的 。 在 一 般 情 
况 下 ,如 果 产 生 随机 过 程 的 主要 物理 条 件 不 随时 间 的 推移 而 改变 ,那么 这 个 随机 过 


程 基本 上 被 认为 是 平稳 的 。 
严 平稳 过 程 具 有 以 下 性 质 : 
性 质 1 严 平稳 过 程 X(z) 的 一 维 概率 密度 与 时 间 无 关 , 即 
fx ti)= fx(aysti + z) 


2. 2. 21 
= fx(x1,0) = fx(x1) € ? 


将 式 (2. 2. 20) 用 于 一 维 时 ,并 且 令 + =— n, 即 可 得 到 式 (2. 2. 21) 。 
由 此 可 知 , XO) 的 数学 期 望 和 方差 也 与 时 间 无 关 , 即 


E[X(D] = 三 =zrxcpdz = mx (2. 2. 22) 


Ra 一 人 G — mey fxGodz = ak(D (2. 2. 23) 


即 对 于 平稳 随机 过 程 , 其 所 有 的 样本 函数 都 在 水 平 直线 mx 的 上 下 以 o% 的 离散 度 , 比 
较 均 匀 地 分 布 。 

性 质 2 ” 严 平稳 过 程 X(z) 的 二 维 概率 密度 只 与 两 个 时 刻 的 间隔 有 关 , 即 

fx zis 5t st) = fx zaiti T rts + r) 
= fx(z1,T230,t, — t1) 

对 于 两 个 随机 过 程 ,可 以 定义 它们 的 联合 严 平 稳 性 。 若 随机 过 程 XG) MYA) 

的 联合 概率 密度 不 随时 间 变 化 , 即 
fr (zt = fy (zsystt rt +r) (2. 2. 25) 

则 称 X(t) 和 Y(z) 是 联合 严 平稳 的 。 s 

由 于 严 平稳 过 程 的 定义 过 于 严格 ,一 般 的 随机 过 程 很 难 满足 。. 因 此 ,比较 常用 
的 是 较 宽 意 义 上 的 平稳 过 程 , 即 宽 平稳 过 程 。 

定义 2.2 若 随机 过 程 X(z) 的 均值 为 一 常数 ,相关 函数 只 与 时 间 间 隔 + — ts 一 
t 有 关 , 即 


(2. 2. 24) 


Rx(ti t2) = ECX (t1) X8ItZs)] = Rx (r) 
ECX (2 ] 一 co 
则 称 XG) 为 宽 平 稳 过 程 ,或 称 广义 平稳 过 程 。 


E[ XG) J = mx(t) = mx 
| (2. 2. 26) 
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由 此 可 知 , 宽 平稳 过 程 XX(z) 的 自 相 关 函 数 和 协 方差 函数 只 是 单 变量 r 一己 一 所 
的 函数 。 

如 果 一 个 严 平稳 随机 过 程 是 均 方 有 界 的 , 即 ELX?(z)] < eo, 则 它 必 是 宽 平 稳 
的 。 反之, 未必 成 立 。 但 是 ,可 以 证 明 , 对 于 正 态 分 布 的 随机 过 程 , 严 平稳 和 宽 平稳 
EFM. 

例 2.1 判断 随机 过 程 X(t) = Acos(wot 十 g) 是 否 是 平稳 过 程 。 其 中 , A w 是 
常数 , p 是 (0,2x) 上 均匀 分 布 的 随机 变量 。 

解 可 以 计算 

EXW] = [Acosta 9) + dg = 0 
Rx(t,t+r)= E(AcosC(osxt + g) Acos[ox (z + z) + @]) 


2 
= Acosta) 


显然 , XO) 满足 式 (2. 2. 26), 因 此 XO 是 广义 平稳 过 程 。 

联合 宽 平 稳 过 程 定义 为 : 当 两 个 随机 过 程 X(z) MYO 均 为 广义 平稳 过 程 , 若 它 
们 的 互相 关 函 数 满足 

Rxy(r) = ELX )Y C +7)] (2. 2. 27) 

WELE XO 和 YG) 是 联合 宽 平稳 过 程 ,也 称 为 联合 广义 平稳 过 程 。 

2. 平稳 随机 过 程 的 功率 谱 密 度 

对 于 确定 性 信号 ,可 以 用 传 里 叶 (Fourier) 变换 求 出 频谱 函数 ,以 便 研究 信和 号 的 
频率 构成 , 称 之 为 频谱 分 析 。 但 是 ,对 于 随机 过 程 所 表示 的 随机 信号 XG), 其 持续 
时 间 一 般 为 无 限 长 ,因此 其 任意 一 个 非 零 样本 xz(z) 也 不 满足 


[lzwla<e 和 和 lz hd < so 


即 不 满足 绝对 可 积 和 能 量 可 积 的 条 件 , 在 这 种 情况 下 就 没有 傅 里 叶 变 换 。 

维 纳 - 辛 钦 (WienerKhinchin) 定 理 为 随机 过 程 的 功率 谱 分 析 提供 了 一 种 解决 方 
法 , 即 如 果 信 号 可 以 看 做 是 广义 平稳 随机 过 程 ,那么 功率 谱 密度 就 是 信号 自 相关 函 
数 的 傅 里 叶 变换 。 用 功率 谱 密度 代替 频谱 来 作为 谱 分 析 , 称 为 功率 谱 分 析 。 

所 谓 功率 谱 , 是 随机 过 程 的 一 个 统计 平均 概念 ,是 随机 信和 号 在 单位 频带 上 的 功 
率 。 通 过 功率 谱 可 以 看 出 随机 信号 的 能 量 随 着 频率 的 分 布 情况 。 由 于 功率 谱 具 有 
单位 频率 的 平均 功率 量 纲 ,所 以 又 称 其 为 功率 谱 密度 (PSD) 。 从 名 称 为 意义 上 来 看 ， 
观测 对 象 是 功率 ,而 观测 域 是 谱 域 。 这 里 的 功率 可 能 是 实际 物理 上 的 功率 ,或 者 表 
示 抽 象 的 信号 数值 的 平方 。 

功率 谱 密度 的 概念 是 针对 功率 有 限 信号 提出 的 。 假 设 zCGO 截断 函数 为 

xlt), ltl<T 


elo Sz 
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其 傅 里 叶 变换 或 频谱 密度 存在 , 即 

Xw = |” rod = f erode (2. 2. 28) 
其 中 , zr(z) 的 平均 功率 为 

W.= lim gpf’, lero ta: (2. 2.29) 
由 Parseval 定理 得 
EEE TE 
则 如 下 等 式 成 立 
w. = lim zX P zr tao = 2: [° [吉林 erwt] ]u 


(2. 2. 30) 
式 中 , 方 括号 内 的 恰好 是 zr(z) 在 单位 频带 上 的 功率 , 称 为 功率 谱 密度 。 
H T =G) 只 是 随机 过 程 X(z) 的 一 个 样本 函数 ,所 以 W, 是 随机 函数 。 如 果 对 所 
有 样本 的 平均 功率 W, 取 统 计 平 均 , 则 得 随机 过 程 的 功率 谱 密度 , 即 


Sw (w) E[lim g |z=r(o) |° ]= lim ET)? (2.2.31) 


功率 谱 密度 是 平稳 随机 过 程 统计 特性 的 一 种 频 域 表示 方法 ,而 相关 函数 则 是 其 
时 域 的 表示 形式 。 下 面 给 出 平稳 各 态 历经 过 程 的 功率 谱 密度 和 相关 函数 之 间 的 
关系 。 

将 式 (2. 2. 28) 代 人 式 (2. 2. 31) ,得 


Sm)= lim E| S, f ardei Cee and] 








N s T T P 
= lim g|, [Elera Ct) Je dade (2.2.32) 


maf, fa Rx (ti —t)e 8-0 dn dt 
其 中 ，* RRAHIM, E XO 为 实 过 程 可 以 省 略 。 
*& r= —t, WJ 
去 三 [Rx — t) ds, dt 


-机 Eee fp asa [Re 六 ed 


Al ET- DR Od +| OTOR ar] 
2T! r T. xe T š T, xne r 


2T ï 
=A[ [7 OT- rR odr] 
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4 T — co Bf, 
2T r 
Saw» = f7 (1 -El )Ra dear 
k (2. 2. 33) 
=[ Raede 


即 功率 谱 密度 是 自 相关 函数 的 傅 里 叶 变 换 。 由 傅 里 时 反 变 换 可 得 
RaO = z. | sayardr (2. 2. 34) 


AC. 2. 33) 和 式 (2. 2. 34) 表 明 ,平稳 过 程 的 功率 谱 密 度 和 自 相关 函数 是 一 个 传 
里 叶 变 换 对 ,这 就 是 著名 的 维 纳 - 辛 钦 定理 。 以 上 两 式 成 立 的 条 件 是 : Sxx Go) 和 
Rxx (z) 均 为 绝对 可 积 的 。 
根据 联合 平稳 互相 关 函 数 的 定义 ,可 以 定义 互 谱 密 度 如 下 
Sw (w) = lim ELX (w)Yr(w)] (2. 2. 35) 


其 中 ，* RAIH. 

互 谱 密度 一 般 用 于 研究 两 个 随机 过 程 之 和 ,或 者 用 于 研究 系统 输入 和 输出 之 间 
的 关系 。 在 Rx (z) 绝对 可 积 的 条 件 下 ,可 以 导出 互 谱 密度 和 互相 关 函 数 之 间 也 存在 
傅 里 叶 变换 关系 , 即 


Sur(o) 一 | ReCDeirrdr (2. 2. 36) 


Re) =} JE Sw (werrdr (2. 2. 37) 
al 


注意 : 

《1) 只 有 在 对 广义 平稳 且 各 态 历经 的 二 阶 矩 过 程 情形 下 功率 谱 密 度 才 有 意义 ， 
其 存在 与 否 取决 于 其 自 相 关 函 数 是 否 存在 及 自 相关 函数 的 傅 里 叶 变换 是 否 收敛 ( 如 
果 信 号 不 是 平稳 过 程 ,那么 自 相关 函数 一 定 是 两 个 变量 的 函数 ,这 样 就 不 存在 功率 
谱 密度 )。 

(2) 平稳 随机 过 程 的 功率 谱 密 度 是 一 个 确定 的 函数 。 

(3) 功 率 谱 密 度 虽 然 保留 了 频谱 的 幅度 信息 ,但 是 丢掉 了 相位 信息 ,所 以 ,对 于 
频谱 不 同 的 信号 ,其 功率 谱 可 能 是 相同 的 。 

〈 纪 随机 过 程 频谱 的 存在 仅仅 取决 于 该 随机 过 程 中 该 样本 的 傅 里 叶 变换 是 否 收 
剑 。 如 果 一 个 随机 过 程 的 频谱 存在 , 即 其 样本 的 傅 里 时 变换 存在 , 则 此 随机 过 程 的 
频谱 也 是 一 个 “随机 过 程 ”。 
22.4 各 态 历经 随机 过 程 


各 态 历经 过 程 又 称 为 遍历 随机 过 程 。 
众所周知 ,为 了 得 到 随机 过 程 X(z) 的 统计 特性 ,必须 进行 大 量 的 试验 。 虽 然 处 
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理 平稳 随机 过 程 比 一 般 随机 过 程 简单 ,但 是 也 需要 大 量 样本 的 集合 。 如 为 了 计算 随 
机 过 程 的 数学 期 望 和 自 相关 函数 的 计算 ,涉及 大 量 的 样本 统计 平均 ,就 希望 寻求 更 
简单 的 方法 。 

如 果 在 某 种 条 件 下 ,随机 过 程 的 时 间 均 值 等 于 其 集合 (多 次 实现 ) 均 值 ,那么 可 
以 选取 固定 时 间 段 内 样本 的 时 间 均 值 来 代替 集合 均值 。 

辛 钦 证 明 : 在 具备 一 定 的 补充 条 件 下 ,对 平稳 过 程 的 一 个 样本 函数 取 时 间 平 
均 , 当 观测 的 时 间 足 够 长 时 , 它 在 概率 意义 上 趋 近 其 统计 平均 。 这 样 的 平稳 过 程 
就 是 各 态 历经 过 程 , 见 图 2. 10(a) 。 各 态 历 经 可 以 理解 为 随机 过 程 的 各 个 样本 函 
数 都 同样 经 历 了 随机 过 程 的 各 种 可 能 状态 , 即 随机 过 程 的 任何 一 个 样本 函数 的 特 
性 都 能 充分 地 代表 整个 随机 过 程 的 特性 。 因 此 ,对 于 各 态 历经 过 程 ,可 以 直接 用 
它 的 一 个 样本 函数 的 时 间 均 值 代替 对 整个 过 程 的 集合 均值 而 加 以 研究 。 
图 2. 10(b) 的 任何 一 个 样本 都 不 能 代表 随机 过 程 的 统计 特性 ,所 以 是 非 各 态 历经 
过 程 。 








中 
图 2. 10 各 态 历经 随机 过 程 和 非 各 态 历经 随机 过 程 


严格 地 说 ,各 态 历经 过 程 的 各 种 时 间 平 均值 在 观测 时 间 充 分 长 的 条 件 下 依 概 率 
1 收敛 于 它 的 概率 域 平均 值 ,或 称 统计 平均 。 各 态 历经 过 程 的 定义 利用 了 平稳 随机 
过 程 的 “统计 特性 与 时 间 起 点 无 关 ” 这 一 性 质 。 

若 平稳 随机 过 程 X(z) 依 概率 1 成 立 , 即 


EIXO] = |7 afrader = lim h S Xd — G. 2.38 


RxD= |? f” = z xG) dan da 
e (2.2.39) 
= lim p| XOXU+ oa = XOXGFO 
则 称 XG) 是 广义 各 态 历经 过 程 。 特 别 地 , 若 平稳 过 程 只 满足 式 (2. 2. 38) 时 , 称 其 均 
值 具有 各 态 历经 性 , 若 只 满足 式 (2. 2. 39) , 称 其 自 相关 函数 具有 各 态 历经 性 。 
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需要 注意 的 是 ,各 态 历经 过 程 必须 是 平稳 的 ,但 平稳 过 程 不 一 定 都 具有 各 态 历 


经 性 。 
例 2.2 讨论 例 2.1 中 随机 过 程 X(t) = Acos(woi 十 g) 的 各 态 历 经 性 。 
解 ” 由 例 2.1 可 知 ,随机 过 程 X(t) = Acos(wwt 十 g) 是 平稳 过 程 ,并 且 有 


2 
f E[XCO] = 0R lete) = Ê coslanr) 
HAHA: 
XO = lim g |” Acos(ast + g) d = lim -SicosgsinuxT = 0 
TaT l-r ER “p aS s 














i 
XOXUFD = lim zh | Atcostast + pcosLuo tt D+ gd = cos(onr) 


可 见 ,随机 过 程 XG) = Acos(wot 十 p) 满足 式 (2. 2. 38) 及 式 (2. 2. 39) ,因此 它 是 各 态 
历经 过 程 。 

除了 式 (2. 2. 38) 及 式 (2. 2. 39) ,判定 一 个 随机 过 程 是 否 具有 各 态 历经 性 ,还 有 
如 下 一 些 条 件 。 

(1) 平 稳 过 程 XG) 的 均值 具有 各 态 历经 性 的 充 要 条 件 是 








lim + I)ER) 一 mJdr = 0 (2.2, 40) 
(2) 平 稳 过 程 X(z) 的 自 相关 函数 具有 各 态 历经 性 的 充 要 条 件 是 
lim + [7 (1 — Z#)[Bea) RO dn = o (2. 2.41) 


RH, BC(n) = ELXC 十 r 十 m)XCG 十 r)XCG 二 nm)XCD]。 
(3) 对 于 均值 为 0 的 高 斯 过 程 XG), 若 自 相关 函数 连续 , 则 X(t) 具有 各 态 历经 
性 的 充 要 条 件 是 


IReD lar< ~ (2. 2.42) 


2.2.5 随机 序列 


当 随 机 过 程 X(z) 只 在 t 的 离散 时 刻 1 ,ts，,…,t, 存在 时 , XO) 是 由 一 串 随机 变 
EX), XG), Xn) 所 构成 的 序列 , 称 为 随机 序列 。 常 见 的 情况 是 为 了 进行 数 
字 信号 处 理 而 将 连续 时 间 信 号 X(z) 均匀 采样 ,形成 随机 序列 {X,,n = 0, + 1, 
土 2,…} , 即 





X, = X(T) 
其 中 , 工 为 采样 周期 。 另 外 ,有 的 随机 信号 本 身 就 是 离散 时 间 形 式 的 。 
与 连续 时 间 随 机 过 程 一 样 ,随机 序列 也 有 相应 的 平稳 性 和 遍历 性 的 定义 。 
如 果 一 个 随机 序列 X, 经 过 时 间 i 平移 后 ,其 概率 统计 特性 保持 不 变 , 即 
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FFx (zyzz…yzoil 2 N) 
=Fx(zmzaa "zas 1+0,2+1, N+ D 
则 称 此 随机 序列 为 严格 平稳 随机 序列 。 由 此 可 知 ,平稳 随机 序列 的 一 维 概率 分 布 函 
数 与 时 间 n AA, Bp 


(2. 2. 43) 


Fx(z,; n) = Fx(z,) (2. 2. 44) 
二 维 概率 分 布 函数 只 与 时 间 差 4 一 m 有 关 , 即 
Fx(z,, Eminim) = Fx(Zezmi72 一 712) (2.2.45) 
均值 , 均 方 值 .方差 都 是 与 时 间 n 2: 059638, Bl 
ux = E(X,) 
š = E(X:) (2. 2.46) 
ak = E((X, — px)? } 


相关 函数 和 中 心 自 相关 函数 
Rx (n,m) = E{znrm} 
Qx n,m) = Rx(n,m) — yix 
只 与 时 间 差 n—m 有关, 即 
Rx(n,m) = Rx(n—m) (2. 2. 47) 
Qx(n,m) = Qx(n— m) (2. 2. 48) 
车 随机 序列 X, 均值 为 常数 ,其 相关 函数 只 与 时 间 差 有 关 , 且 均 方 值 有 限 , 则 称 
之 为 广义 平稳 随机 序列 ,简称 平稳 序列 。 一 个 严格 平稳 随机 序列 必 为 广义 平稳 随机 
序列 ,反之 未 必 成 立 。 
若 随机 序列 X, 的 各 种 时 间 平均 (时 间 足 够 长 的 情况 下 ) 依 概率 1 收敛 于 相应 的 
概率 域 平 均 , 则 称 之 为 严 各 态 历经 序列 。 
若 平稳 随机 序列 X, 的 时 间 均 值 和 相关 函数 依 概 率 1 收敛 于 相应 的 概率 域 均值 
和 相关 郑 数 , 则 称 X, 为 宽 各 态 历经 随机 序列 ,简称 各 态 历经 序列 。 对 于 各 态 历经 随 
机 序列 ,其 优点 是 几乎 所 有 可 能 的 取样 序列 的 时 间 平 均 量 都 是 相同 的 ,因此 可 以 用 
任 一 取样 序列 的 时 间 平均 来 代替 其 统计 平均 , 即 





— j SL > 
E(X,) = lim INFI DZ (2. 2. 49) 
N 
Rx (m) = lim wF Xz zn +m) (2. 2. 50) 


设 X, 为 广义 平稳 随机 序列 , 当 其 自 相关 函数 Rx (zz) = E(X,X,,,,) 满足 
> |Rx@) |< co 
时 , 称 Rx Gn) 的 离散 傅 里 叶 变换 Sx (w) 为 X, 的 能 量 谱 密度 , 即 
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Sx(w) = A XR vene (2.2.51) 
Rx (m) 也 可 以 表示 为 Sx (w) 的 傅 里 时 反 变 换 , 即 
Rx(m = [° Sree (2. 2. 52) 
在 原点 处 有 
Rx(0) = Í Sx do (2.2. 53) 


式 (2. 2. 53) 说 明 , 能 量 谱 在 一 周期 下 的 面积 是 随机 序列 X, 的 均 方 值 。 
2.2.6 常见 的 随机 过 程 


1. 马尔 可 夫 过 程 

马尔 可 夫 过 程 是 一 类 重要 的 随机 过 程 ,由 俄国 数学 家 马尔 可 夫 于 1907 年 提出 。 

过 程 或 系统 在 上 一 如 时 刻 状 态 已 知 的 条 件 下 ,过程 在 时 刻 :之 如 所 处 状态 的 条 件 
分 布 与 过 程 在 时 刻 to 之 前 所 处 的 状态 无 关 的 特性 称 为 马尔 可 夫 性 或 无 后 效 性 。 通 
俗 地 说 ,在 给 定 当 前 知识 或 信息 的 情况 下 ,过 程 “将 来 ”的 情况 与 “过 去 ”的 情况 是 无 
关 的 。 具 有 马尔 可 夫 性 的 随机 过 程 称 为 马尔 可 夫 过 程 。 

若 随机 过 程 (XG): € T) IHERHA t < t < tri < t, <t € T HERR 
B zira tm oz 满足 

PLX(D < z | Xt) = zi XG, a) = Lra XG,) = zx,] 
=P[X() < z | XG,) = =,J ep 

则 称 XO 为 马尔 可 夫 过 程 ,简称 马 氏 过 程 。 

RO. 2. 54) 说 明 ,在 XG.) = zi = 1,2,…,n 为 已 知 的 条 件 下 ,事件 (XG) 一 
z) 发 生 的 概率 只 与 最 近 时 刻 z, 的 情形 有 关 , 而 与 1 ,ts，,…, 时 刻 的 情形 无 关 。 

若 随机 过 程 (XG): € T) 对 任意 时 刻 过 ts 二 … <, a <rt, <t ET 及 任意 
实数 zi za "zo T 满足 

PEXG) < z | Xt) = z, XG.) = z-i, XG) = zs] 
一 PLX(CD < z | Xm) = Imi Xt,) = =,] (2:2355) 

则 称 XG) 为 二 阶 马尔 可 夫 过 程 。 

具有 马尔 可 夫 性 质 的 离散 时 间 随 机 过 程 称 为 马尔 可 夫 链 ,简称 马 氏 链 。 

在 现实 世界 中 ,有 很 多 过 程 都 是 马尔 可 夫 过 程 ,如 液体 中 微粒 所 作 的 布朗 运动 、 
传染 病 受 感染 的 人 数 、 车 站 的 候车 人 数 等 。 

2. 白 噪 声 过 程 

1) 理 想 白 噪声 过 程 

理想 白 噪声 过 程 是 随机 性 最 强 的 平稳 过 程 。 它 的 功率 谱 密度 在 整个 频率 区 间 
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(一 co, + e°) 是 均匀 分 布 的 , 即 功率 谱 密度 是 恒定 的 常数 
Sx(w) = A 2.2.56) 
其 中 ,Ao 是 常数 。 其 中 ,“ 白 ” 字 借 用 了 光学 中 “白光 ”的 概念 ,因为 白光 的 光谱 包含 了 
所 有 可 见 光 的 频率 成 分 , 且 强 度 相等 。 相 对 来 说 ,其 他 不 具有 这 一 性 质 的 噪声 信号 
被 称 为 有 色 了 噪声。 
由 维 纳 - 辛 钦定 理 可知 , 理 想 白 噪声 过 程 的 自 相关 函数 为 
RG) = Sx(e)errdr = 2rho8(a (2.2.57) 


式 中 , 6(r) Æ Direct- ó 函数 ,定义 为 
oor=0 
Or 天 0 
白 噪 声 的 功率 谱 密度 和 自 相 关 函 数 如 图 2. 11 所 示 。 


Sr(@), Rx(?), 


a) = i [Fws 





- 
加 o 
(a) (b) 


图 2.11 白 噪声 的 功率 谱 密 度 和 自 相关 函数 


AC. 2.57) 正 是 对 白 噪声 的 “白色 ”性 质 在 时 域 的 描述 。 由 于 随机 过 程 的 功率 
谱 密度 是 其 自 相关 函数 的 傅 里 叶 变换 ,而 $ 函数 的 传 里 叶 变换 正 是 常数 。 

以 上 表明 , 白 噪声 的 自 相关 函数 是 d 函数 ,在 任意 两 个 相 邻 时 刻 的 取 值 都 不 相 
关 , 即 白 噪声 过 程 随时 间 的 起 伏 极 快 ,具有 无 限 带宽 ,因而 其 能 量 无 限 大 。 但 实际 
上 ,这 在 现实 世界 是 不 可 能 存在 的 。 白 噪声 只 是 一 种 理想 化 的 模型 ,在 数学 处 理 上 
比较 方便 。 一 般 地 ,只 要 一 个 噪声 过 程 所 具有 的 频谱 宽度 远 远大 于 它 所 作用 系统 的 
带宽 ,并 且 在 该 带宽 中 其 频谱 密度 基本 上 可 以 作为 常数 来 考虑 ,就 可 以 把 它 作为 白 
噪声 来 处 理 。 例 如 , 热 噪 声 和 散 弹 噪声 在 很 宽 的 频率 范围 内 具有 均匀 的 功率 谱 密 
度 , 通 常 可 以 认为 它们 是 白 噪 声 。 

需要 指出 的 是 ,“ 白 色 ” 仅 意味 着 信号 是 不 相关 的 , 白 噪声 的 定义 并 没有 对 信号 
应 当 服 从 哪 种 概率 分 布 作出 任何 假设 。 因 此 ,如 果菜 白 噪 声 过 程 服 从 高 斯 分 布 , 则 
它 是 高 斯 白 噪声 。 类 似 地 ,还 有 泊 松 白 噪 声 , 柯 西 白 噪 声 等 。 根 据 中心 极 限定 理 , 现 
实 世 界 中 的 许多 过 程 都 可 以 近似 地 视 为 高 斯 白 噪声 。 

上 面 定义 的 白 噪 声 只 是 一 种 理想 化 的 模型 ,实际 上 这 种 白 噪声 是 不 存在 的 。 由 
式 (2. 2.57) 可 得 


at 





Rx(0) = 2xA28(0) = co (2. 2. 58) 
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这 说 明理 想 白 噪声 过 程 的 均 方 值 为 无 穷 大 ,而 物理 上 存在 的 随机 过 程 的 均 方 值 总 是 
有 限 的 。 尽 管 如 此 ,由 于 白 噪声 在 数学 处 理 上 具有 简单 且 方 便 等 优点 ,因此 它 在 系 
统 分 析 等 实际 应 用 中 仍 占有 极其 重要 的 地 位 。 在 工程 实际 中 ,系统 的 带宽 总 是 有 限 
的 。 当 所 研究 的 随机 过 程 通过 某 一 系统 时 ,只 要 过 程 的 带宽 远大 于 系统 带宽 ,而 且 
在 系统 带宽 范围 内 过 程 功率 谱 密度 基本 恒定 ,就 可 以 把 它 作 为 白 噪声 来 处 理 。 
2) 限 带 白 噪声 过 程 
“ 限 带 白 品 声 过 程 ” 也 是 一 个 常用 的 重要 概念 。 如 果 平 稳 随 机 过 程 X(t) 的 功率 
谱 密 度 在 某 一 有 限 频带 内 均匀 分 布 , 而 在 此 范围 外 为 0, 则 称 此 过 程 为 限 带 白 噪声 过 
程 。 限 带 白 噪声 过 程 又 分 为 低 通 型 白 噪声 和 带 通 型 白 噪声 。 
如 果 过 程 X(z) 的 功率 谱 密度 只 在 低频 的 有 限 带宽 内 恒定 ,而 在 此 频带 外 都 等 
于 零 , 即 要 
Sx(w) = | sss (2. 2. 59) 
则 称 X(z) 为 低 通 型 限 带 白 噪 声 。 它 的 自 相关 函数 为 
Rx(D 一 | searrdw 
(2. 2. 60) 





=[ Aset dw = 2Aom Snr 
低 通 型 限 带 白 噪声 的 功率 谱 密度 Sx(w) 和 自 相关 函数 Re Co) 如 图 2. 12 所 示 。 


Sr(@) 





(a) 
图 2. 12” 低 通 型 限 带 白 噪声 的 功率 谱 密 度 和 自 相关 函数 
从 图 2. 12 中 可 以 看 出 , 低 通 型 限 带 白 噪声 过 程 在 z — x/wo 的 整数 倍 各 点 上 
Rx(r) = 0。 因此 ,如 果 以 + 作为 采样 间隔 对 此 过 程 采样 ,得 到 的 各 采样 值 是 互 不 相 
关 的 。 如 果 这 些 采样 值 还 是 互相 独立 的 , 则 称 为 白 噪声 序列 。 此 时 , 自 相关 函数 为 
Rxm) = só (m) (2. 2. 61) 
式 (2. 2. 61) 中 , 8(m) 为 Direct- 8 函数 , 即 


òlm) = 


白 噪声 过 程 的 功率 谱 密度 为 n 
Sx(w) = = (2. 2. 62) 
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理想 白 噪声 过 程 通过 一 个 理想 的 低 通 滤波 器 便 可 以 产生 出 低 通 型 限 带 白 噪声 
过 程 。 
如 果 限 带 白 噪声 过 程 XG) 的 功率 谱 密度 中 心 频率 为 + oo, 带宽 为 B, BJ 

B B 

se -人 a <lo |< +$ 

0， 其 他 

则 称 X(z) 为 带 通 型 限 带 白 噪声 ,其 自 相关 函数 为 
Rx(1) = 2AB DBD cosasr (2.2. 64) 
带 通 型 限 带 白 噪声 的 功率 谱 密度 Sx (o) 和 自 相关 函数 Rx(r) 如 图 2. 13 所 示 。 将 理 

想 白 噪声 过 程 通过 一 个 理想 的 带 通 滤波 器 便 可 以 产生 带 通 型 限 带 白 噪声 过 程 。 


(2. 2. 63) 


Sr(®) 











图 2.13 带 通 型 限 带 白 噪声 过 程 的 功率 谱 密 度 和 自 相关 函数 


3. 高 斯 过 程 

高 斯 过 程 又 称 为 正 态 过 程 ,是 一 种 普遍 存在 和 重要 的 随机 过 程 。 通 信 信 道中 的 
噪声 通常 是 一 种 高 斯 过 程 , 故 又 称 之 为 高 斯 噪声 。 如 果 随 机 过 程 X(z) 在 任意 有 限 
BIR n z, PIs 其 任意 半 维 概率 分 布 服从 高 斯 分 布 , 则 X(z) 是 高 斯 过 程 。n 维 概率 
密度 函数 如 下 
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Fal Ers Erts Tah st stn) 


Í 1 < < z; —m;)/z, —m, 
(r) 000, | B|1⁄2 -el 2[B >> 1Bla( oj )( Y )] 


j=1 t=1 
(2. 2. 65) 











式 中 ， 
zi 一 一 第 k 个 样本 函数 在 某 时 刻 的 值 ; 
m = ELE) J — t = 时刻 随机 变量 的 均值 ; 
a = E [EU —m, 一 一 上 一 大 时 刻 随机 变量 的 方差 ， 
[B| 一 一 归 一 化 协 方差 矩阵 的 行列 式 , 即 
bi bz … bm 
Ba us: t 
b. be … bm 


[Bla — |B| PEX ba 的 代数 余子 式 ; 
ba 一 一 归 一 化 协 方差 函数 , 即 
r —m; iea) —m J), jk 
ba = 





UjOk 
1, j=k 

高 斯 过 程 具有 以 下 一 些 性 质 : 

(1) 统 计 特性 由 数字 特征 唯一 确定 , 即 如 果 已 知 m.o、B, 则 fa Cest) 唯一 确定 。 

《2) 宽 平稳 高 斯 过 程 一 定 是 严 平稳 高 斯 过 程 , 即 对 于 高 斯 过 程 来 说 , 宽 平稳 和 严 
平稳 是 一 致 的 。 

(3) 如 果 高 斯 过 程 在 不 同时 刻 的 取 值 是 互 不 相关 的 ,那么 它们 也 是 统计 独立 的 。 

(4) 若干 个 高 斯 过 程 之 和 仍 是 高 斯 过 程 。 

(5) 高 斯 过 程 通过 线性 变换 后 仍 为 高 斯 过 程 ,只 是 输入 输出 的 数字 特征 是 不 
同 的 。 

(6) 如 果 高 斯 过 程 的 积分 存在 , 则 它 也 是 高 斯 分 布 的 随机 变量 或 随机 过 程 。 

(7) 平 稳 高 斯 过 程 导数 的 一 维 概率 密度 也 是 高 斯 分 布 ,而 且 均 值 为 0。 

对 于 高 斯 随机 过 程 X,t € T), WRI FIER tistrein € T,X), 
X(t ),…, 义 (tm) 是 相互 独立 的 高 斯 随机 变量 , 则 称 (XG) ,t € T) 为 高 斯 白 噪声 过 
程 ,其 相应 的 离散 过 程 称 为 高 斯 白 噪 声 序 列 。 对 于 一 个 高 斯 白色 过 程 来 说 , 它 的 概 
率 分 布 服 从 高 斯 分 布 , 即 完全 由 其 均值 和 协 方差 矩阵 确定 ,而 它 的 功率 谱 密度 又 是 
均匀 分 布 的 。 在 以 后 的 学 习 中 ,为 简化 所 研究 的 问题 ,系统 干扰 和 测量 噪声 经 常 被 
假定 为 高 斯 白 噪声 。 

如 果 随机 过 程 (XO), € T) 既是 高 斯 随机 过 程 ,又 是 马尔 可 夫 随 机 过 程 , 则 称 
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该 过 程 为 高 斯 -马尔 可 夫 随 机 过 程 。 相 应 的 离散 过 程 称 为 高 斯 -马尔 可 夫 序 列 。 对 于 
指标 集 为 工 = {k:k 二 0,1,…} 的 一 个 高 斯 -马尔 可 夫 序 列 ,如 果 初 始 概率 密度 函数 
f[z(0)] 和 转移 概率 密度 函数 f[z=(k--1) | z=<Gz)] 是 已 知 的 ,那么 过 程 的 分 布 特性 可 
以 完全 确定 。 


4. 独立 增 量 过 程 
车 有 随机 过 程 (XG): € T), B XG) 一 0 HFE i <t << t,, 增 量 
XC) — X1) X Ct) — X(t) XG.) — X Cin) 是 相互 独立 的 随机 变量 , 则 称 


XG) 为 独立 增 量 过 程 。 
如 果 独 立 增 量 过 程 是 均值 为 常数 的 二 阶 矩 过 程 ,那么 它 一 定 是 正 交 增 量 过 程 。 
若 (XO), |t |< so) 是 零 均值 独立 增 量 过程 , 且 有 
E[X(t) — X) F = Ptt), > h (2. 2. 66) 
MJ XG) 均 方 导数 过 程 就 是 白 噪声 过 程 。 或 者 说 , 白 噪声 过 程 的 均 方 积 分 过 程 是 零 
均值 独立 增 量 过 程 。 
5. 维 纳 过 程 
若 零 均值 随机 过 程 {X(D，|  |<co) 对 于 任意 4 过 刀 < T, W XG) — Xa) 
具有 正 态 NO, Vts — n) 分 布 ,其 中 o> 二 0 为 常数 , 则 称 XG) 为 维 纳 过 程 。 
维 纳 过 程 又 称 为 布朗 运动 ,具有 如 下 特点 : 
(1) 它 是 一 个 马尔 可 夫 过 程 。 因 此 ,该 过 程 的 当前 值 包含 了 对 未 来 预测 中 所 需 
的 全 部 信息 。 
《2) 维 纳 过 程 具有 独立 增 量 。 该 过 程 在 任 一 时 间 区 间 上 变化 的 概率 分 布 独立 于 
其 在 任 一 其 他 时 间 区 间 上 变化 的 概率 。 
(3) 它 在 任何 有 限时 间 上 的 变化 服从 正 态 分布 , 其 方差 随时 间 区 间 的 长 度 旦 线 
性 增加 。 
维 纳 过 程 的 相关 函数 为 
Rx Cti sta) = omin(n , t) (2. 2. 67) 
6. 泊 松 过 程 
若 随机 过 程 (XG): € [yco) 六 三 0) 的 状态 只 取 非 负 整 数值 , 目 满足 下 列 条件 
(DD P{X(1) =0} = 1; 
(2) XG) 为 均匀 独立 增 量 过 程 ; 
(DIFERA tst E [t ,co),n < t, 相应 的 随机 变量 增 量 XG) — X) 
服从 数学 期 望 为 1(z — n) 的 泊 松 分 布 , 即 
PIXO =X) = À) = DG CI ers (2. 2. 68) 


则 称 XG) 为 泊 松 过 程 。 
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泊 松 过 程 有 着 广泛 的 应 用 。 例 如 ,在 固定 时 间 间 隔 内 到 某 商店 去 的 顾客 数 , 通 
过 某 交 又 路 口 的 汽车 数 , 船 舶 甲板 上 海浪 的 次 数 , 海 浪 波 面 超 过 某 一 立 值 的 次 数 , 数 
字 通 信 中 编码 信号 的 误 码 个 数 等 都 可 以 用 泊 松 过 程 描述 。 


7. 正 交 增 量 过 程 
著 二 阶 矩 过 程 (XG): € T), B XG) = 0 对 于 任意 4 <t Sh <ha A 
E(X) — XG) JLXG, — XG DJ) 一 0 (2. 2. 69) 


则 称 XG) 为 正 交 增 量 过 程 。 
正 交 增 量 过 程 XO 的 相关 函数 为 
Rist), ht 


Rx (tist) = (2. 2. 70) 
ENDE lie, L< 


8. 扩散 过 程 

扩散 过 程 最 初 是 指 微小 颗粒 悬浮 在 液体 中 的 无 规则 运动 。 布 朗 最 早 进行 了 这 
方面 的 研究 ,发 现 了 它 的 运动 规律 ,因此 扩散 运动 又 称 为 布朗 运动 ,而 扩散 过 程 称 为 
布朗 运动 过 程 ,一 般 用 BCt,w) 或 BLz) 表示 。 

扩散 过 程 在 每 一 次 实现 中 ,样本 B(t,w) 的 曲线 都 是 发 散 的 。 因 此 ,在 多 次 实现 
中 ,对 于 某 一 个 时 间 截 面 占 来 说 , BG, +) 的 方差 值 将 随时 间 的 差 值 (一) 成 比例 
增 大 。 考 虑 到 扩散 运动 在 不 同时 间 截 面 中 是 互相 独立 的 , 它 必 然 有 马尔 可 夫 过 程 的 
特性 , 即 无 后 效 性 ,因此 扩散 过 程 又 称 为 扩散 的 马尔 可 夫 过 程 。 

扩散 过 程 可 以 看 作 是 一 个 独立 增 量 过程 。 若 用 X(t,w) 表示 白 噪 声 , 则 扩散 过 
程 Bt,w) 可 表示 为 

BG, ) = X (tis *) — X(t, °) 

由 于 X(t,w) 呈正 态 分 布 ,在 给 定 的 时 间 截 面 # € 工 中 , pG, e) 是 一 个 由 高 斯 独立 
增 量 之 和 组 成 的 随机 变量 ,因此 B(z:,。) 也 是 正 态 分 布 的 ,其 数学 期 望 ,方差 及 相关 
函数 表示 为 


EL8CD)] 一 0 (2. 2.71) 

D[0G.)] = ELF t] =qlti— tl (2. 2. 72) 

E[8GO8G;)]= ELA G) ] + EREDT) — Ba: J) (2.2. 73) 
= E[#G)]= qli — tl We; 


式 (2. 2. 72) 中 , q 称 为 扩散 系数 , 表示 方差 随时 间 差 值 而 增 大 的 比例 系数 。 
RC. 2. 73) 利 用 了 关系 式 BG.) = Ba) +G) — BD] E B) 和 PBs) 一 Bi) 是 
相互 独立 的 事实 。 

扩散 过 程 8C) MARE WO 之 间 有 如 下 的 关系 , 即 


BD = j Wod RBL — Wo) (2.2.14) 
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即 扩散 过 程 是 白 噪声 的 积分 。 但 实际 上 ,扩散 过 程 是 不 可 微 的 ,因此 式 (2. 2. 74) R. 
在 形式 上 成 立 , 只 能 认为 , 白 噪声 通过 积分 环节 ,输出 信号 为 扩散 过 程 。 
在 一 般 情况 下 ,扩散 过 程 X(z) 由 随机 微分 方程 描述 , 即 


XD = aX, D +b(X,DW(D (2. 2.75) 


式 (2. 2.75) 中 , a(t) WDG) 为 连续 的 确定 函数 ; WC) 为 零 均 值 的 高 斯 白 噪 声 ,强度 
为 g(CbD。 式 (2.2.75) 的 解 为 


XG) = X(t) +Í a(X,Ddr+ [| b(X,)W(Dd: (2. 2. 76) 
和 


如 前 所 述 ,由 于 扩散 过 程 不 可 微 , 所 以 式 (2. 2. 75) 也 只 具有 形式 上 的 意义 ,而 
式 (2. 2. 76) 是 正确 的 。 


2.3 海浪 随机 过 程 


2.3.1 典型 的 海浪 随机 过 程 模型 


无 论 在 时 间 上 ,还 是 在 空间 上 ,海浪 的 波 面 高 度 均 具有 不 规则 性 和 不 重复 性 。 
研究 海浪 的 运动 及 统计 规律 ,建立 其 数学 模型 ,对 于 船舶 工程 和 海洋 工程 具有 重要 
意义 。 但 是 ,海浪 与 风 、 海 域 及 海流 等 多 种 因素 有 关 , 因 此 很 难 准确 建立 完整 描述 海 
浪 的 数学 模型 ,而 只 能 在 一 些 假设 的 条 件 下 ,建立 一 些 比较 实用 的 近似 模型 。 统 计 
结果 表明 ,经 过 强风 长 时 间 吹 过 后 的 海面 形成 的 成 熟 波浪 可 以 认为 是 一 个 高 斯 分 布 
的 平稳 随机 过 程 。 皮 尔 逊 (Pierson) 等 人 在 大 量 的 实测 和 理论 研究 基础 上 给 出 了 一 
个 海浪 能 量 谱 密 度 函 数 , 即 PM(Pierson-Moscowitz) 谱 


S™ (w) = eå 


et (2.3.1) 
式 (2.3.1) 中 , 取 A = 0. 78,B = 3. 11/H}, H, 为 海浪 的 有 义 波 高 , PM 谱 线 图 如 
图 2. 14 所 示 。PM 谱 被 第 11 届 国 际 水 池 (ITTC) 会 议 建议 为 单 参数 标准 波谱 。 根 据 
给 定 的 海 情 等 级 ,能 得 到 相应 的 有 义 波 高 , 则 根据 PM 谱 公式 就 可 以 得 到 海浪 谱 及 各 
种 统计 特征 。 

方差 


a = [7 sa ` 
n Er 
m, = [erSe(w) do 
平均 周期 


4. 最 优 估计 理论 


T= 2r, /2 
m2 

T... = 2x ° 
m. 


20 世纪 70 年 代 初 , 美 、 英 、 德 , 荷 等 国 的 海洋 学 者 通过 北海 海浪 联合 计划 ,对 德 

国 海湾 Sylt 岛 延伸 到 160km 的 海域 测 得 的 海浪 数据 进行 处 理 , 给 出 了 JONSWAP 
波谱 。 该 谱 是 PM 谱 乘 上 一 个 考虑 优先 风 区 的 修正 因子 F, BI 

SP (w) = SP (o) F (2. 3. 2) 


式 中 , F= Fr yel- SE) ,y 表 示 JONSWAP 波谱 与 PM 波谱 最 大 值 之 比 , 它 表 现 
为 在 有 限 风 区 情况 下 使 PM 谱 峰 值 的 升 高 ,其 值 一 般 在 1. 5~6 之 间 , y = 1 时 就 是 
PM É, o, 为 谱 峰值 频率 , o 为 谱 峰 值 形状 参数 ,Fr! 表示 在 相同 的 风 区 和 风速 时 ， 
JONSWAP 谱 曲线 下 的 面积 与 PM 谱 曲 线 下 的 面积 之 比 。JONSWAP 波谱 曲线 如 


2.15 所 示 。 





最 大 周期 


02 04 06 08 oArad/s) 02 04 06 08 whrad/s) 
图 2.14 PM 谱 曲 线 图 2.15 JONSWAP 谱 曲 线 


如 果 将 JONSWAP 波 中 的 PM 谱 用 H, 和 全 两 个 参数 表示 , 且 取 w = 4. 85T7, 
则 有 


i 
SP (w) = S F y (1) (2. 3. 3) 
式 中 ， 
0. 07， “< 
Tı = 2x ,0 = 
Q 0.09, “> t 


1978 年 ,第 15 届 国 际 水 池 会 议 建 议 采 用 JONSWAP 平均 波谱 (Y = 3. 3 ), 即 


SPa) = HHE exp (Fe. 3e Cy) (2.3. 4) 


作为 有 限 风 区 的 波谱 。 
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2.3.2 海浪 随机 过 程 仿真 


由 于 船舶 经 常 在 海浪 中 运动 ,所 以 在 研究 和 设计 船舶 的 控制 系统 时 ,经 常 需要 
研究 海浪 对 船舶 及 其 控制 系统 的 影响 ,尤其 是 动力 定位 船舶 需要 较 高 的 定位 精度 。 
为 了 研究 上 述 问题 ,需要 有 一 个 比较 理想 的 海浪 信号 模型 ,海浪 的 实时 仿真 可 以 解 
决 这 个 问题 。 

对 于 具有 有 理 谱 平稳 随机 过 程 的 仿真 ,利用 成 形 滤波 器 的 方法 很 容易 解决 。 然 
而 海浪 过 程 是 具有 非 有 理 谱 的 随机 过 程 ,很 难 解决 它 的 仿真 问题 。Mikio、Hino 曾 利 
用 有 理 谱 逼 近 非 有 理 谱 的 方法 对 海浪 随机 过 程 进 行 仿真 ,但 至 少 需要 20 阶 的 成 形 滤 
波 器 才能 近似 实现 ,这 对 于 工程 应 用 来 说 是 比较 繁琐 的 。 

研究 船舶 在 随机 海浪 作用 下 的 运动 特性 和 船舶 动力 定位 系统 在 海浪 作用 下 的 
动态 响应 时 ,经 常 把 海浪 作为 一 个 平稳 随机 过 程 来 处 理 。 在 目前 的 研究 中 , 常 采用 
长 峰 波 海浪 ,假定 随机 海浪 是 由 许多 不 同 波长 和 波幅 的 谐 波 琶 加 而 成 ,每 个 谐 波 都 
朝 同一 个 前 进 方向 。 下 面 从 谱 分 解 的 观点 研究 具有 非 有 理 谱 平稳 海浪 随机 过 程 的 
仿真 问题 。 

在 工程 应 用 中 ,一 般 采用 单 侧 谱 , 即 


Fx(w) = I 





0, <0 
2Sx(w), o> 0 
下 面 首 先 针对 这 种 情况 ,不 加 证 明 地 引入 两 个 定理 。 
定理 2.1 XO 为 实 平稳 过 程 ，Fx(w) 为 其 功率 谱 密 度 函 数 , 则 仿真 过 程 
RO 可 取 为 
Rao) = 27 (&cosàe + msinë;zt) (2. 3.5) 


式 中 , (G) Mi) (i = 1,2,…) 为 零 均 值 互 不 相关 随机 序列 , 且 
Elg} = 0, ij =1,2, 


EIG) = Elf) = [Fx odo 
四 
规定 = 0,i = (wi 十 wan)/2, 定义 仿真 误差 elz) = XA — RU), B. 
E[e(#)] = o,E[e (oJ) = > [六 ProD[I 一 cs 一 apoadw (2. 3. 6) 
£= 的 


定理 2.2 XO 为 实 平稳 正 态 过 程 , Fx(w) 为 其 功率 谱 密度 函数 , 则 仿真 过 
ELO 可 取 为 


Ra) = DX costó 一 si) (2. 3.7) 
RP, XG 一 1,2,…) 为 相互 独立 的 瑞 利 分 布 的 随机 变量 , 且 
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E(x?} = 2 [H Fx lodo 2.3.8) 
a 


而 ei(i 二 1,2,…) Earn] E EE 5 Xi(G 二 1,2,…) 相互 独立 ; 
对 于 仿真 误差 e(z), 仍 满足 式 (2. 3. 6) 。 

可 以 看 到 ,在 仿真 模型 式 (2. 3. DAR. 3. 7) 中 , 均 包 含 两 个 随机 变量 。 这 里 
根据 第 二 个 模型 , 提出 一 个 更 简单 的 仿真 模型 ,将 式 (2. 3. 8) 中 的 E{X;) 替代 
式 (2. 3.7) 中 的 X;, 于 是 得 到 


ka) = > “H E y (o) dw X coslôt — e:) (2. 3. 9) 


可 以 看 出 ,模型 式 (2. 3. 9) 是 一 个 守 频 带 能 量 等 效仿 真 模型 ,这 在 工程 应 用 中 比较 方便 。 
下 面 利用 仿真 模型 式 (2. 3. 9) 模 拟 五 级 海 况 下 的 海浪 随机 过 程 ,并 进行 检验 。 
其 中 ,海浪 谱 Fx(w) 采用 PM 谱 , 即 
z 


Fx(w) = Ae-2 
wW 


AP, AA =8.1X10° Xg, B= 3. 2X10? (g/H,)’,g = 9. 8m/s:,H, = 3. 65m, 
若 取 M=50 MERTEN, RRC. 3. 10) 可 得 


[F aoa, = 


(2. 3. 10) 


BD (2.3.11) 
其 中 
w = [B/C,(AM+ D/G- D] i = 2,3,---,M+1 (2. 3.12) 

为 了 检验 海浪 仿真 过 程 KG) 与 真实 海浪 过 程 X(t) 相 比 有 多 大 畸变 ,进行 均值 

检验 ,方差 检验 和 功率 谱 检 验 , 有 如 下 结果 
E(XG)) = 0,0% = 0. 8468 
E{£)} = 0. 002,0% = 0. 8300 

HLO 计算 周期 图 并 经 适当 平均 可 求 出 功率 谱 Fe(w)。 在 图 2. 16 中 , 实 线 表 
示 PM 谱 Fx (o), 圆圈 表示 仿真 过 程 广 (2) 的 谱 Few). 由 图 2. 16 可 以 看 出 ， Fe(o) 
比较 接近 Fx(w)。 图 2. 17 给 出 了 仿真 过 程 RO) 的 一 个 样本 。 


2.3.3 海浪 阔 值 的 概率 预报 


研究 海浪 闭 值 的 概率 预报 问题 对 于 研究 海洋 平台 和 舰 船 甲板 上 浪 的 概率 预报 
问题 及 海洋 工程 系统 的 设计 等 都 具有 重要 的 意义 。 

RNO 为 时 间 [o, £] 内 空间 上 某 一 固定 点 的 海浪 波 面 高 度 超过 阔 值 a+ (或 低 
Ta )( 记 为 事件 A) 发 生 的 次 数 。 时 间 “0” 表 示 开 始 观测 的 时 间 起 点 。 以 海浪 波 面 
静水 面 为 纵 坐标 的 零点 。 由 于 海浪 的 随机 性 , NO 的 发 生 也 是 随机 的 ,因此 (NG), 
t> 0) 构成 一 个 随机 过 程 。 由 NCO 的 物理 意义 可 知 , NO 具有 如 下 特点 : 
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图 2.16 五 级 海 况 下 的 PM 谱 与 贸 (1) 的 谱 Fx (o) 
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图 2.17 五 级 海 况 下 RO 的 一 个 样本 函数 


(1) NG) 是 一 个 计数 过 程 , 且 NO) = 0,NG) 之 0,N(ts) > NG), 22 t, 

(2) 在 时 间 G, r+ Az) 内 , 当 At 一 0 时 ,事件 A 出 现 两 次 及 两 次 以 上 的 概率 是 小 
概率 事件 。 

(3) NG) HIRE, ER EERE] t < te < ta <ie < tea < ta P, 
n 个 随机 变量 NCG) , NC) s N03) NOn) ，N(z,) 的 增 量 过 程 NG) 一 
NG) Na) 一 Na) NGC) 一 NGC) 在 统计 上 相互 独立 。 

(4) NG) 为 平稳 增 量 随机 过 程 。 

定义 Y(7) = NG + r) — N0) ,Y(z) 表示 以 时 间 :为 起 点 ,在 时 间 间 隔 r* 中 的 时 
间 A 发 生 的 概率 ,显然 过 程 Y(r) 独立 于 时 间 上 而 仅 取决 于 r。 因 此 , Y(r) 为 平稳 随 
机 过 程 ，N(z) 为 平稳 增 量 随机 过 程 。 

根据 随机 过 程 理论 ,具有 上 述 特点 的 随机 过 程 NGO 的 增 量 过 程 Y(r) 服从 泊 松 
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分 布 , 即 在 时 间 间 隔 + 内 ,空间 上 某 一 固定 点 的 海浪 波 面 高 度 超过 阐 值 at 〈 或 低 于 
a 六 次 的 概率 为 
PY = b) = 全 er (2.3.13) 


式 中 , 8 为 单位 时 间 内 事件 A 发 生 的 数学 期 望 。 
8 的 求 取 是 一 个 随机 过 阅 问 题 。 事 件 A 发 生 的 条 件 为 
€G) Sat A) 三 0 (2. 3. 14) 
或 
ED <a gG) < 0 (2. 3. 15) 

ECO 为 海浪 波 面 高 度 瞬 时 值 ; at 39 8 FZ ERE a 为 低 于 静水 面 之 
FEBRIE., FEAR. 3. 14) 的 情况 为 例 进行 研究 。 

记 单 位 时 间 内 , gC) 由 下 而 上 与 六 值 a+ 的 次 数 为 Ns+。 由 于 EO) 的 随机 性 , 因 
此 ,对 于 固定 的 at N+ 也 是 一 个 随机 变量 。 

在 时 间 轴 上 选取 两 个 时 刻 t,t 十 rt, 设 &(z) 在 此 两 个 时 刻 取 值 的 二 维 联合 概率 密 
度 为 felta), 则 在 时 间 间 隔 (t,t 十 7) 内 , EO 至 少 有 一 次 由 下 而 上 与 at 相交 的 概 
率 为 

P,(at)= P{é(t) < at, Elar) > at) 


=Í [Ace zOdzdz, 
如 果 z 趋 于 无 穷 小 , 则 式 (2. 3. 16) 表 示 EO 由 下 而 上 与 at 相交 一 次 的 概率 。 在 
无 穷 小 的 时 间 间 隔 [t,t 十 J 内 , &(z) 不 越过 at 的 概率 为 1 一 P,(at), 单位 时 间 内 
€G) 越过 at 的 平均 次 数 为 E{N。*+)，, 故 在 时 间 间 隔 [ z, + z] 内 G) 越过 at 的 平均 
次 数 为 E (Nt), 当 r 趋 于 无 穷 小 时 ,有 
zE(N,t)= 1X Part) 十 0X[1 一 Par)] 
= P.(at) 


(2.3.16) 


# 
E{N,+} = lim LP, (a+) = Pla (2.3.17) 
r T Br 
对 式 中 的 工 和 xz, 作 如 下 变量 置换 , 即 


T= 2 一 去 = 
= = x+ 


-£ 
l 2 


变换 的 雅 可 比 行列 式 为 


Arz.) _ 


Ə(y,z) r 


2 
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因此 
四 


feo zzy + z2 rdydz (2.3. 18) 


+ 
¿t= 


P,(at) = k 
由 于 





于 是 , 当 r 一 0 时 ,大 (> 一 下 =,? 十 可 zjz 为 时刻 &(?) 与 6(z) 的 联合 概率 密度 , 即 


imfe(y— zy +5z)= fe oD (2.3.19) 
进而 得 
E(N,*) = [== (z, )d2 (2. 3. 20) 


根据 海浪 理论 , EO 可 视 为 各 态 历经 的 平稳 高 斯 过 程 ,并 且 &(z) 的 均 方 导数 过 程 
&(z) 亦 为 高 斯 随机 过 程 。&(z) 与 EO 的 协 方差 为 


CofE EW] = lim f eode = o (2. 3. 21) 
故 &t) 和 ÈG) 是 相互 独立 的 ,从 而 有 
fa Gas) = feia) fa GD = ç 





1 AN z 
mp z z) (2. 3. 22) 
式 中 
a= [se dwt = [sa 


其 中 , Se(w) 为 海浪 波 面 高 度 能 量 谱 密度 函数 。 
将 上 述 结果 代入 式 (2. 3. 20) ,得 


| S.C) 
P= E(N,+} li = =l D" | (2. 3. 23) 
J ,SeCw) do 2f Selw) dw 
FERA N BEEF E a 的 数学 期 望 6- 为 
省 Se de -y2 
iE = =l <a | (2.3. 24) 
VJ Seow 2 | Se ao 


利用 仿真 数据 对 式 (2. 3. 13) 的 概率 模型 进行 皮尔 逊 -X 检验 , 即 如 下 校 验 问题 
Ho:F(z) = Fe(z), Hi: F(z) # Folz) 
AP, Fe (z) 为 泊 松 分 布 的 分 布 函数 。 
由 皮尔 逊 定理 可 知 , 当 假设 H, 成 立时 ,统计 量 











P= EIND) 
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= m (2. 3. 25) 


t=1 


服从 自由 度 为 m 一 1 的 六 AA. 

式 中 , = 为 总 体 Y(r) 的 样本 容量 , fi 为 观测 频数 , np, 为 理论 频数 , 且 有 p, = 
F,G2—F(k—1), 

取 r = 210s, at= 1.5m, 利用 有 义 波 高 为 3. 65m 的 海浪 仿真 数据 计算 


式 (2. 3. 25) ,结果 为 
p = 8. 6235 


在 显著 水 平 a = 0.1 F ,# x 分 布 表 得 
X m — 1) = 12.017 
HT p < 2, —1), BE a = 0.1 水平 下 接受 假设 Ho, 即 认 为 Ytr) 服从 泊 
松 分 布 的 假设 成 立 , 从 而 式 (2. 3. 13) 成 立 。 
利用 概率 预报 模型 式 (2. 3. 13) 可 以 方便 地 进行 海浪 波 面 在 时 间 间 隔 * 内 超过 某 
一 阐 值 a+ (或 低 于 a” ) 次 的 概率 预报 问题 。 
海浪 的 PM 能 量 谱 密度 函数 为 
Selo) = 全 (mè + s) (2. 3. 26) 


于 是 有 


2.4 线性 定常 系统 对 平稳 随机 过 程 的 响应 


在 工程 系统 的 分 析 与 设计 中 ,经 常会 遇 到 随机 信和 号 作为 输入 的 情形 。 例 如 , 船 
舶 在 航行 中 会 受到 海浪 等 随机 干扰 作用 ,电子 系统 会 受到 电源 波动 及 电子 热 噪声 的 
影响 ,无 线 电 通信 系统 信息 的 接收 处 理 中 会 遇 到 无 线 电 噪声 的 影响 等 。 所 以 ,有 必 
要 研究 随机 信号 通过 线性 定常 系统 后 的 响应 ,这 也 是 第 4 章 维 纳 滤波 器 推导 中 所 需 
要 的 有 用 结果 。 


2.4.1 线性 定常 连续 系统 


设 线 性 定常 连续 系统 如 图 2. 18 所 示 , G(s) 为 系统 的 传递 函数 , hO 为 系统 的 
脉冲 响应 函数 ,系统 的 输入 X(t) 为 均 方 连续 的 平稳 随机 过 程 ,其 均值 为 mx G) , 相 
关 函 数 为 Rx(r), 功率 谱 密度 为 Sx(w)。 假定 系统 是 渐进 稳定 的 , 即 所 有 的 特征 根 均 
具有 负 实 部 , 则 必 有 
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[aya < (2.4.1) 


由 于 h(z) 为 G(s) 的 拉 氏 反 变换 , 即 MD 
ha) = L 1(G6(s)) ° 
则 输出 与 输入 的 关系 为 


yo =| WXG-DR 2.4.2 


由 随机 过 程 理论 知 , YO) 是 均 方 收敛 的 ,上 且 当 XG) 为 平稳 过 程 时 , YO 也 为 平稳 过 
程 ,其 均值 为 


G(s) YO 。 


图 2.18 线性 定常 连续 系统 


my(D) = EYO] 
=E[[ hwxa-va] 


> 2.4.3 
= 全 haoE[xc 一 D]d @ 9 


= hma 


相关 函数 为 
Ry(z)= E[Y(t+rY()] 


= E| | AQyxe + da DX pay] 
=E[ aADXGtr -AXEDA] QA OD 
=[[ [hhWELXG+ r— XG — Jada 


= [f7 [7 hOAPR e—a + Ddy 
Y(z) 的 功率 谱 密度 函数 为 


Sw E |T Rode 
ime e (2.4.5) 
= 去 [六 [T ADAPR eat pedd 


EAC 4.5), 9 £= raty WA 
S= 1. Ü Rodr 
To 


= [aya a f" aperar? LRO C2.4.6) 


= G(jw)G(— jw) Sx (w) 
= [GGeo) ° Sx w) 
AP, G(jw) = G(s) | sivo 
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2.4.2 线性 定常 离散 系统 


线性 定常 离散 系统 见 图 2. 19, G) 为 系统 的 传递 函数 , hA 为 系统 的 脉冲 响 
EC an O.o 应 函数 ,系统 的 输入 X(k) 为 平稳 随机 序列 ,其 均值 
为 mx(k), 相关 函数 为 Rx(Czz)， 功 率 谱 密度 为 
图 2. 19 ”线性 定常 离散 系统 Sx(z) 。 
假定 系统 是 稳定 的 , 即 G(x) 所 有 的 极点 均 在 单位 圆 内 。 由 于 hCk) X Ge) 的 
= 变换 , 即 
h(k) = z [G(z)] 


且 有 
Ë 
27 G 一 co (2. 4.7) 
= 
因此 ,系统 输出 序列 了 (n) 与 输入 序列 XO) 的 关系 为 
Yo) = SAG XG — D (2.4.8) 
k=— 
根据 随机 过 程 理论 , 4 X(z) 为 平稳 序列 时 , YC) 也 是 平稳 序列 ,其 均值 为 
myw = E[Y (n) ] 
+= 
= 如 > ha 一 DXCD] (2. 4.9) 
i 
= J, h(n— k)mx(k) 
相关 函数 为 
Ry(m)= ELY(DYGI+m)J] 
£= += 
= a| D AWXU— K) > ADXU+m—] (2.4.10) 
h=—o0 j=” E 
-5 SAOAOR mtk =j) 
功率 谱 密度 为 


Sy(z) = G(z)G(z 1)SxCz) (2. 4.11) 


2.5 随机 向 量 正 交 投影 理论 


随机 向 量 的 正 交 投影 理论 是 第 6 章 和 第 8 章 中 推导 卡尔 曼 滤波 公式 时 必 不 可 少 
的 工具 ,在 此 先 作 介绍 。 
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j X #1Z ZSI RI —BFEE BJ n 维和 m EREL, WRES X EE 
机 向 量 误 ,满足 下 列 三 个 条 件 : 

(1) 久 可 以 由 忆 线 性 表示 , 即 存在 非 随机 向 量 a 和 n X m HEEB, E = 
a+BZ. 

(2) $ ETMK, B ER = EX). 

(3) X— 5ZEZ, El E(X — ZT 一 0。 

MFK K E: X tE Z ERRE iH K = EX | 刀 。 此 处 ,均值 “人 "表示 “线性 ”。 

由 线性 最 小 方差 估计 理论 知 ,基于 测量 量 忆 的 X 的 最 小 方差 估计 总, 满足 投影 
定义 中 的 三 个 条 件 。 

关于 向 量 投影 ,有 下 面 的 结论 。 

结论 1 设 X 和 2Z 为 具有 二 阶 矩 的 随机 向 量 , 则 怀 在 忆 上 的 投影 改 唯 一 地 等 于 
基于 的 线性 最 小 方差 估计 , 即 

ÊX | D) = E(X) + Cov(Xx,Z) (Var2) [2Z— EZ] (2.5.1) 

证 RO. S5. DAWE X 35 Z 的 线性 最 小 方差 估计 ,因此 只 需 证 明 X 在 Z 上 
的 投影 向 量 户 (X | Z) 与 之 相等 。 

由 投影 定义 中 的 条 件 (1) 和 条 件 (2) ,可 知 

ÊX) = a + BE(Z) = E(X) 








故 有 
a = E(X) — BE (Z) (2. 5. 2) 
于 是 
Å — a+ BZ = E(X) +B[Z— E(2)] (2. 5. 3) 
估计 误差 为 
X— = X— E(X) — B[Z — E(Z)] 
由 条 件 (3) 得 
EX- ÑZ = 下 {[X 一 下 (CX)] 一 BLZ 一 下 (Z)]}ZT 
= Cov(X,Z) 一 BVarZ = 0 
因此 


B = Cov(X,Z) (VarZ) ` (2.5.4) 
将 式 (2. 5.4) 代 入 式 (2. 5. 3), 式 (2. 5. 1) 就 得 到 了 证 明 。 
结论 2 EX lZ 为 具有 二 阶 矩 的 随机 向 量 , 4 为 非 随机 矩阵 ,其 列 数 等 于 瑟 的 
维 数 , 则 
ÊX | D = AÉ(x | 2) (2.5.5) 
证 由 结论 1 得 
ÊX | Z)= ECAX) + Cov(AX ,Z) (Varz)? [Z— E(Z)J 
= AE(X) + ACov(X,Z)(VarZ) [Z — E(Z)] 
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= A(E(X) + Cov(X,Z)(VarZ) '[Z — E(2)]} 
= AE(X | Z) 
结论 3 设 XY 和 2 为 具有 二 阶 矩 的 随机 向 量 , AMB 为 具有 相应 维 数 的 非 随 
机 和 矩阵, 则 有 
ÊX + BY | Z) = AÉ (X | Z) + BÉ (Y | Z) (2. 5. 6) 
证 由 结论 (1) 得 
ËCAX + BY | Z)= E(AX + BY) + Cov(AX + BY,Z) (VarZ)2 [Z— E(Z)] 
= E(AX) + Cov(AX,Z)(VarZ) [Z — E(Z)] 
十 ECBY) + Cov(BY,Z) (VarZ) [Z — E(Z)] 
= Ê(AX | Z) + ËGBY | Z) 
再 由 结论 (2) 得 
ÊX | Z) = AE(X|D 
E(BY | Z) = BÉ (Y | Z) 
故 有 
E(AX+BY | Z) = AÉ (X | Z) + BÉ (Y | Z) 


Z, 
结论 4 RXZ RZ, HENAN MENL, H Z 一 z]. 则 
EA |D= É(x | Z) + Ë(X | Z,) 本 
= ÊX | 21) +Ê ZDE ŽD 2, w 


式 中 ， 


证 由 结论 (1) 可 知 
ËCK|Z,)= E(X) +Cov(X, Z,)XVarZ,)[ Z, — E(Z,)] 
= [E(XZDJLEE(Z, 21)]! Z, 

故 式 (2. 5. 7) 中 第 二 个 等 号 得 证 。 为 证 明 式 (2. 5. 7) 中 第 一 个 等 号 ,根据 结论 
(1) 的 投影 唯一 性 ,只 需 验证 ÊX | Z) + (XZ, Ë (Z, ZZ, EE X#E Z 上 的 投 
影 , 即 验证 入 满足 投影 定理 的 三 个 条 件 。 . 

首先 ,因为 EX |Z) A ÉCZ, | Z) 都 可 由 Z, 线性 表示 ,从 而 Z, 可 由 也 线性 表 
RMA RETH ZRERR. 

其 次 ,由 于 ER) = EX | Z) +E(xZT)[E(Z,Z1)]1E(Z,) = EX) ,所 以 ， 
入 是 无 偏 估计 。 
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BUA, i+ ËCZ,|Z,) 可 由 Z, 线性 表示 ,和 投影 定义 的 条 件 (3) 知 , X 5 Z, fü Z 
正 交 , 故 有 
ELÃÊ (Z, | Z?) = 0 
E[Z,Ë (Z, | ZI 一 0 
Eik 
EC(XZ21) = E(X27) + ELXE (Z|21)7] = EŠ ŽP 
E(Z,21) = E(Z,ZT) +E[ Z,Ë (Z|21)7] = E(Z, Z?) 
H+ Z JE: Z, 和 2 的 复合 向 量 ,因此 
E(X —Å)Z"= EÑZ" — (EX Z1)(EZ,) 1 (E,Z) 
= (EŠ Z} ,EŠZĮ) — (EX ZI)(E2,) 1 (EZ,ZT ,EZ,ZI) 
= (0,EXZID —[0, (EŠ ZI (EZ, (EŽ,EŽ™)] = 0 
于 是 QÑ) 与 Z 正 交 得 证 。 进 一 步 ,根据 结论 1 OREHE, THN £ E: x EZ 
上 的 投影 。 因 此 , 式 (2. 5.7) 得 证 。 


2.6 AE F 3 mi 


最 优 估计 理论 研究 中 采用 的 系统 模型 为 状态 空间 模型 , 即 由 矩阵 和 向 量 所 描述 
的 模型 ,因此 在 估计 理论 和 方法 的 讨论 过 程 中 涉及 大 量 的 矩阵 和 向 量 计算 ,为 此 首 
先 给 出 矩阵 论 中 的 一 些 基本 结果 。 


2.6.1 向 量 的 基本 运算 


向 量 , 即 排 成 一 行 或 一 列 的 元 素 , 可 以 看 做 是 矩阵 的 特殊 情况 。 常 用 的 是 列 向 
量 的 情况 ,例如 # 维 向 量 x 


x= (2.6. 1) 
向 量 加 法 ”两 个 向 量 相 加 定义 为 


x+ya (2. 6. 2) 


. 56 。 最 优 估计 理论 





类 似 的 方法 可 以 定义 向 量 减法 。 需 要 注意 的 是 , 当 两 个 向 量 相 加 减 时 ,它们 的 维 数 


必须 相同 。 
标量 与 向 量 相 匀 一 个 向 量 可 以 乘 以 标量 ,得 
kzı 
kx = mi (2.6. 3) 
kz. 


零 向 量 ”每 个 元 素 都 是 0 的 向 量 定义 为 零 向 量 。 
ARRE ”定义 列 向 量 (2. 6. 1) 的 转 置 为 如 下 行 向 量 


xT = [zi zs "tt, zi] (2. 6.4) 
反之 , 行 向 量 (2. 6. 4) 的 转 置 为 列 向 量 x(2. 6. 1) 。 
向 量 内 积 称 
xTy= riy +z: 十 … 十 Zayn (2. 6. 5) 
为 向 量 x MER y HAR RAR., xy = 0, 则 称 x 和 y 是 正 交 的 。 此 外 ,用 
|x|= VXITY (2.6.6) 
表示 向 量 x 的 长 度 (或 称 向 量 的 模 ) 。 
向 量 外 积 fk 
TN Ty ° Yna 
kar E A eA (2.6.7) 
xi Tny2 ** LnYn. 
为 向 量 的 外 积 。 


向 量 微 分 定义 向 量 值 函数 x(z) 的 微分 为 对 向 量 的 每 一 个 元 素 取 微分 , 即 
3 GD 


X(t) = NAS (2. 6. 8) 
40 
2.6.2 和 矩阵 的 基本 运算 
矩阵 就 是 一 个 矩形 的 数 表 。 例 如 ,一 个 闫 行 z 列 的 矩阵 为 
an am * a 
A= | R UO “= (2.6.9) 


Ami Am ° Qm 
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上 述 矩 阵 可 简写 为 4 = [aj lmno H m = n Bf, HERE A 称 为 方 阵 。 对 于 方 阵 , 从 左上 
角 起 到 右 下 角 为 止 的 元 素 an ,azz，…，,au 称 为 主 对 角 线 。 列 向 量 (2. 6. 1) 可 以 看 作 是 
nX1 的 矩阵 ,而 行 向 量 (2. 6. 4) 可 看 作 是 1 n 的 矩阵 。 

矩阵 加 法 ”只 有 当 两 个 矩阵 的 维 数 相等 , 即 具 有 相同 的 行 数 和 列 数 时 才 可 以 相 
加 减 。 两 个 矩阵 相 加 ,和 和 矩阵 的 每 个 元 素 为 两 个 矩阵 对 应 元 素 的 和 , 即 


A+B [ai +b,] (2. 6. 10) 
标量 与 矩阵 相 乘 ”和 矩阵 4 可 以 乘 以 标量 上 , DRA 表示 , 即 
kA = [has] (2. 6. 11) 


RERA “EBE ARER B 的 乘积 记 为 4B。 RAH AHB 可 以 相 乘 时 , AB 才 
有 意义 , 即 A 的 列 数 要 等 于 B 的 行 数 。 假 设 4 为 mXp 阵 , B 为 pXn 阵 , 若 定 义 C== 
AB, WERE C 中 的 元 素 为 


p 
c; = Daabs (2. 6. 12) 
k=1 


注意 ,对 于 维 数 相同 的 方 阵 4 AB, 乘积 4B 和 BA 都 有 意义 ,但 一 般 AB + BA , 这 是 
因为 只 有 当 两 个 矩阵 的 对 应 元 素 相 等 时 , 才 可 以 说 它们 相等 的 。 

对 于 矩阵 乘法 ,有 下 列 基本 性 质 : 

(1) AGBC) = (AB)C , 

(2) A(B+C) = AB +AC 。 

向 量 -矩阵 相 乘 “FH x 和 和 矩阵 4 是 可 以 相 乘 的 , 即 矩 阵 的 列 数 和 向 量 的 长 度 
相等 , 则 乘积 y = Ax 定义 为 

x= Dos = 12, *,m) š (2. 6. 13) 


矩阵 微分 和 积分 如 果 和 矩阵 是 时 间 的 函数 ， BDA 二 A(z), 则 可 以 定义 其 微分 和 
积分 为 š 

AG) = [és (1)] 2.6.14) 

faoa = [fasa] (2.6.15) 


零 矩阵 ”如 果 一 个 矩阵 中 的 每 个 元 素 都 是 0, 则 定义 为 零 矩 阵 。 
单位 矩阵 ”如 果 方 阵 主 对 角 线 上 的 元 素 都 是 1, 而 其 余 元 素 均 为 0, 则 称 其 为 单 
位 矩阵 , 记 为 1, 任何 矩阵 与 同 维 的 单位 矩阵 相 乘 , 结 果 不 变 , 即 4hT = IA = A, 
ERITI n 阶 方 阵 A4 有 行列 式 , 记 为 |A| , 是 一 个 标量 ,定义 为 
14| 一 > È- ‘Zaraz -an (2. 6. 16) 


= j=l 


式 中 ,7 天 站 天 加 7。 每 一 项 中 ,第 二 个 下 标记 “ 必 是 数 1,2,…,n 的 一 个 排列 。 
下 标 为 偶 排 列 的 项 取 正 号 ,而 下 标 为 奇 排列 的 项 为 负 号 。 
和 矩阵 行列 式 通 常 的 一 个 用 途 是 通过 克 莱 默 (Cramer) 法 则 解 线性 方程 组 ,但 是 由 
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于 计算 量 按 指数 增长 ,所 以 只 限于 求解 小 型 线性 方程 组 。 目 前 ,对 于 大 规模 的 线性 
方程 组 ,一 般 利用 计算 机 ,采用 迭代 法 等 求解 。 甜 阵 行列 式 的 另 一 个 主要 作用 是 判 
断 矩 阵 是 否 可 逆 。 

矩阵 行列 式 有 下 列 性 质 ， 

G) |AB|= |A|- |B| (4 和 B 均 为 方 阵 )。 

(2) 14 | 二 "|4| CA 为 方 阵 , 1 是 常数 )。 

矩阵 的 逆 ”考察 矩阵 的 逆 时 ,只 限于 方 阵 。 如 果 人 4 是 方 阵 ,并 且 是 可 逆 的 ,其 逆 


以 4” 表示 , 则 
A'A=A47 =I (2. 6. 17) 


MRI HENA ERRA A, RARR RIETAN. HWER 4 为 非 奇 
异 的 一 个 准则 是 | A|> 0, 可 以 证 明 , 对 于 非 奇异 矩阵 ,有 
A 一 irada (2. 6. 18) 

其 中 , adjA 是 伴随 矩阵 ,是 由 A 的 代数 余子 式 置换 其 每 个 元 素 ,并 将 结果 转 置 而 得 。 
其 中 ,ai 的 代数 余子 式 , 是 从 4 中 删 掉 第 i TRB 列 后 形成 矩阵 的 行列 式 ,再 乘 以 
CDH 而 得 。 

矩阵 求 逆 引 理 ”如果 对 任 一 盖 X 半 维 非 奇 异 矩阵 4 与 任意 两 个 n X m 维和 矩阵 B 
和 C, 矩阵 (A + BCT) #l (I+ C'A-1B) 都 是 非 奇异 的 , 则 下 式 成 立 


(A+ BCT): = A — A` B (1 +C"A™ B) CA~ (2. 6. 19) 
非 奇异 矩阵 有 下 列 基 本 性 质 ， 
Q) QA) 1 = A7 (是 常数 ) 。 
(2) |A-1|=1⁄1A| 。 


(3) (AB)! = B>A” , 
ERRE ”通过 互 换 矩 阵 的 行 和 列 就 得 到 矩阵 的 转 置 , 即 
A = [a;J,AT = [a;] (2. 6. 20) 

Eliik,— ` mX n ERER ERE nXm Bl), JFIRE A= A", 则 4 称 为 对 称 矩 阵 。 

矩阵 转 置 有 下 列 性 质 : 

(1) (4B)T = B'A", 

(2) (A)T = (AT) (A 非 奇异 ) 。 

和 矩阵 的 迹 ” 方 阵 4 的 迹 是 对 角 线 元 素 的 标量 和 , 即 


u[A]= Slas (2. 6.21) 
i=l 


对 于 方 阵 4 MB, 有 tr[L4B] = tr[BA]。 
和 矩阵 的 秩 ERA 的 秩 是 包含 在 4 中 有 非 零 行列 式 的 最 大 方 阵 的 维 数 。 如 非 
奇异 n 维 方 隆 有 秩 n。 


第 2 章 数学 基础 + 59 + 





方 阵 函 数 ” 当 》 为 标量 时 ,方程 
fQ)= |M —A|= 0 (2. 6. 22) 
称 为 方 阵 4 的 特征 方程 。 满 足 该 方程 的 4 值 是 方 阵 A 的 特征 值 。 
凯 莱 -哈密 顿 定理 指出 ,对 于 同样 的 多 项 式 表达 式 fe), 有 
fA 一 0 (2. 6. 23) 
即 ,每 一 个 方 阵 都 满足 它 的 特征 方程 。 
和 矩阵 指数 et 方 阵 4 的 一 个 特殊 多 项 式 函数 ,定义 为 


r NE AAN 
t =I+A+5 t37 t (2. 6. 24) 


矩阵 指数 常 出 现在 常 系数 矩阵 微分 方程 的 研究 中 。 
矩阵 指数 有 下 列 一 些 常 用 关系 式 ， 
(1) e = ee ( AB = BA ), 
(2) emr' = TFT? (TZ 0), 
(3) |er|= en, 


2.6.3 向 量 -矩阵 运算 


由 于 n 维 向 量 可 以 看 作 是 nX1 的 矩阵 ,因此 上 述 对 矩阵 的 运算 对 向 量 运算 也 适 
用 。 下 面 介绍 几 种 更 常见 的 向 量 和 矩阵 相 结合 的 运算 。 

二 次 型 ”对 于 一 个 nXn 的 对 称 矩阵 4 An 维 向 量 x, 定义 标量 

J = x!Ax (2. 6. 25) 

或 

了 一 anzi Hanai +e Hamri + 2(aumiz i Hantit + +a, iwzaiz,) 
称 此 标量 表达 式 为 二 次 型 。 在 最 优化 理论 中 ,三 次 型 常用 于 定义 需 优化 的 指标 
函数 。 

定 的 形式 ”二 次 型 可 以 进一步 用 于 确定 矩阵 A 的 性 质 ， 

若 对 于 所 有 实 x,xr4x > 0, 则 称 4 为 正定 ; 

若 对 于 所 有 实 x,xr4x > 0, 则 称 4 为 半 正 定 ; 

若 对 于 所 有 实 xx" Axr < 0, 则 称 4 为 负 定 ; 

若 对 于 所 有 实 x, xT Ax < 0, WEA 为 半 负 定 。 

矩阵 范 数 “与 向 量 的 长 度 类 似 , 和 矩阵 相 联系 的 数量 称 为 范 数 ,定义 为 


141 = max ll (2. 6. 26) 
在 向 量 的 长 度 如 式 (2. 6. 6) 定 义 的 情况 下 ,可 以 计算 出 


A || = VAA (2. 6. 27) 
AH, ATA) 为 ATA 的 最 大 特征 值 。 
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微分 运算 ”上 面 给 出 了 向 量 和 矩阵 表达 式 相对 于 时 间 标 量 的 微分 法 ,下 面 给 出 
向 量 相对 于 向 量 和 和 矩阵 的 微分 法 则 。 一 般 称 向 量 微 积分 中 的 导数 为 梯度 。 
1) 标 量 函 数 对 向 量 与 矩阵 的 微分 运算 
(1) 标 量 函 数 对 向 量 的 微分 运算 。 
设 n 维 向 量 x 的 标量 值 函 数 为 
z= f(x) = f(mi,zz t  z,) 


M| z = f(x) 对 x 的 导数 是 向 量 


a =a (2. 6. 28) 
其 中 
a= z (2. 6. 29) 
标量 z 相对 于 向 量 x 的 二 阶 偏 导数 是 一 个 矩阵 , 即 
x= =A (2. 6.30) 
其 中 
= oz 
a = Sros, (2.6.31) 
矩阵 4 称 为 z 的 海 森 (Hessian) 和 矩阵 。 
一 个 比较 重要 的 情况 是 内 积 对 向 量 的 梯度 ,假设 》 是 与 x 维 数 相同 的 向 量 , 则 有 
ĝo» = y (2. 6.32) 
和 
Daty 一 了 (2. 6. 33) 
E . 6. 
(2) 标 量 函 数 对 矩阵 的 微分 运算 。 
HX Hm Xn 维和 矩阵 , 即 
Tu Tiz * Tin 
S Sa 
Tm Lm č * Xx, 


其 标量 值 函 数 为 z = f(X) = fz yz Tin Ta Ze sE} Ln Tn" y 
==) W) z = fX) 对 互 的 梯度 为 矩阵 , 即 


az- 
ax B (2. 6. 34) 


其 中 
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b; = = (2. 6. 35) 
《3) 和 矩阵 的 迹 和 行列 式 对 矩阵 的 微分 运算 。 


和 矩阵 的 迹 和 行列 式 是 两 类 特殊 的 标量 函数 。 对 于 方 阵 A.B 和 C, 下 面 给 出 几 种 
常用 的 梯度 函数 情况 。 


uA] =I 
人 Laac] = BrCr 
总 [ABA] = A(B+B') 
grie = 


= = -LT 
341BAC| |BAC| (47) 


2) 向 量 值 函 数 与 矩阵 值 函 数 对 向 量 的 微分 运算 
《17 向量 值 函 数 对 向 量 的 微分 运算 。 
设 向 量 值 函数 y ( y 5 x 可 以 不 是 同 维 的 ) 为 
fia zz *** Tn) 
F=f = fbr ra) 


mh Ei Zo °° ,Tn) 
34 x 为 列 向 量 时 , y 相对 于 x 的 梯度 为 矩阵 , 即 
& -=J (2. 6. 36) 
式 中 
一 3 
J; = ax; (2. 6. 37) 
矩阵 了 称 为 ?的 雅 可 比 (Jacobian) 和 矩阵 。 
(2) 矩 阵 值 函数 对 向 量 的 微分 运算 。 
设 矩 阵 值 函 数 F) = [fo Gazi sz En) Jons 其 中 x 为 n 维 向 量 , 则 F(x) 对 x 
的 梯度 为 向 量 , 即 
aF) _ 
U (2. 6. 38) 
其 中 


b, = dx; (2. 6. 39) 
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3) 和 矩阵 函数 的 逆 对 标量 的 微分 运算 
BAG) 为 n 阶 可 逆 阵 , 则 A 对 z 的 梯度 为 


AT =— a Maa (2, 6.40) 


4) 二 次 型 及 双 线 型 对 向 量 的 微分 运算 
BAKE Q = x! Ax, HEPA Hn 阶 对 称 方 阵 , x 为 n 维 向 量 , 则 Q 对 x 的 偏 导 
数 为 





== 24r (2.6.41) 
对 于 双 线 型 @ = x"Ay , 其 中 A 为 n 阶 对 称 方 阵 , x 和 y 为 n 维 向 量 , 则 
W — GAT = hrx (2.6.42) 
ay 
思 考题 


2-1 将 一 个 温度 调节 器 放置 在 存储 着 某 种 液体 的 容器 内 ,调节 器 设 定 在 4C ,液体 的 温度 X 
(以 'C 计 ) 是 一 个 随机 变量 , 且 X — N(d,0. 5*)。 若 要 求 保持 液体 的 温度 至 少 为 80C 的 概率 不 低 于 
0. 99, 问 d 至 少 为 多 少 ? 

22 有 两 个 相互 独立 工作 的 电子 装置 ,它们 的 寿命 X, = 1,2) 服从 同一 指数 分 布 ,其 概率 
密度 为 


1 sz 
二 fr w, z>0,0>0 
0, “<o 
若 将 这 两 个 电子 装置 串联 连接 组 成 整 机 , 求 整 机 寿命 (以 小 时 计 )N 的 数学 期 望 。 
2-3 设 (X,Y) 服从 二 维 正 态 分 布 , 它 的 概率 密度 为 





一 Gaa, ayu) | (y— D 

TR a e e a) 
求 X 与 Y 的 相关 系数 。 

24 HX ~N), Y ~ Nud), Hit XA Y 相互 独立 , 求 Z 二 aX 十 BY 和 Zi 二 aX 一 
BY 的 协 方差 。 

2-5 ”随机 变量 X 的 概率 密度 函数 表示 为 

Fa= 人 0 和 zs1l 
0 其 他 

计算 

《1) 概 率 分 布 函数 Fx (z); 

(2) 期 望 ELX]; 

OF 2 [x]. 


26 设 (XCG),:220) 为 随机 过 程 , XCz) = A, 其 中 A 为 随机 变量 且 分 布 函 数 Fa(z) = P(A 
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< =) 为 已 知 , 求 有 限 维 分 布 函数 族 。 

2-7 设 随机 过 程 (XO), —co <t <00} 和 {Y(D , —co < <+e=o) 的 均值 函数 为 mx (t) 和 
m), AA HHBE Dx (a st) H TY (Cas); 又 f(z) g(t) 和 glz) 为 普通 实 函数 , 求 随机 过 
# (ZG) = FOXO HOYU) +o), —co < t <+ o0) 的 均值 函数 及 自 相关 函数 Tz(b t). 

28 (XG), 0} 为 维 纳 过 程 , 求 XG + D — X( 的 自 相关 函数 ,其 中 ! 为 实 常 数 。 

2-9 随机 过 程 {X(D ,一 co < 上 一 二 co) EXX XU) = Ar +B, 其 中 A,B 为 随机 变量 且 一 阶 


矩 和 一 阶 抵 存在 , 求 Y(D) AL | Xde g Ze 全 EO 的 均值 函数 及 自 相关 函数 。 


2-10 É (Z,x=0,1,2--) 为 正 态 随 机 序列 , 它 均 方 收 敛 于 随机 变量 Z, 证 明 Z 是 正 态 随 机 
变量 。 

2-11 设 { 和 光一 0,1,2…) 为 一 阶 滑动 和 序列 XX(k) = KHOR), JEP RA k=, 
一 1,0,1,…} 是 相互 独立 且 服 从 正 态 N(0,1) 分 布 的 随机 变量 序列 ; C > 0, 为 常数 。 请 问 该 过 程 
是 否 为 正 态 过 程 ,平稳 过 程 .马尔 可 夫 过 程 及 独立 增 量 过 程 ? 

2-12 设 线性 定常 系统 的 结构 图 如 下 图 所 示 , 其 中 系统 输入 为 X(t) = 0, 初始 条 件 Y(0) 为 正 
态 随机 变量 , 且 E[Y(0)] = 0 , E[Y*(0)] = ,分 析 系 统 输出 过 程 {Y(t) ,t > 0), 


» X00 WD 
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内 容 提 要 ”本章 介绍 估计 的 基础 理论 ,包括 最 常用 的 最 优 估计 准则 、 最 小 二 乘 
估计 、 最 小 方差 估计 、 线 性 最 小 方差 估计 、 极 大 似 然 估计 及 极 大 验 后 估计 。 


3.1 常见 最 优 估计 准则 


最 优 估计 是 建立 在 某 种 最 优 估计 准则 基础 上 的 ,不 同 的 估计 准则 导致 不 同 的 估 
计 方 法 。 下 面 介绍 一 些 常用 的 估计 准则 。 

1) 无 偏 估计 

无 偏 估计 是 最 普遍 的 估计 准则 。 所 谓 无 偏 估计 ,是 指 状态 的 估计 值 * 和 真实 值 


具有 相同 的 均值 。 这 实际 上 等 价 于 说 估计 误差 x = x 一 人 具有 零 均 值 , 即 EC z) = 
0。 无 偏 估 计 是 基本 的 估计 准则 ,往往 与 其 他 估计 准则 结合 使 用 , 如 无 偏 最 小 方差 估 
计 和 无 偏 线性 最 小 方差 估计 。 

2) 最 小 二 乘 估计 

最 小 二 乘法 是 高 斯 提出 的 ,是 将 测量 残 差 8 = z, 一 H,ç 的 平方 和 最 小 作为 最 优 
估计 准则 的 估计 方法 。 如 果 不 知道 x 和 z 的 一 阶 矩 和 二 阶 矩 及 它们 的 概率 密度 ,这 
时 可 以 采用 最 小 二 乘法 得 到 最 优 估计 。 

3) 最 小 方差 估计 

最 小 方差 估计 准则 是 在 一 切 可 能 的 估计 中 ,将 估计 误差 方差 阵 P(x) 最 小 的 估 
计量 作为 最 优 估计 。 为 了 进行 最 小 方差 估计 ,需要 知道 被 估 值 x 和 观测 值 x 的 条 件 
概率 密度 p(x | z) 或 Aa), 以 及 它们 的 联合 概率 密度 p(x,z)。 

4) 线 性 最 小 方差 估计 

如 果 只 知道 观测 值 和 被 估 值 的 一 阶 矩 和 二 阶 矩 , 即 E[x]、E[zj、Var[xj、Var[zj 
和 Cov[x,z], 在 这 种 情况 下 ,为 了 得 到 最 优 估计 结果 ,必须 对 估计 量 的 形式 加 以 限 
制 。 假 定 估 计 值 是 观测 值 的 线性 函数 ,以 估计 误差 阵 达 到 最 小 作为 最 优 估计 的 准则 
求 得 的 最 优 估计 值 称 为 线性 最 小 方差 估计 。 

5) 极 大 似 然 估 计 

极 大 似 然 估计 是 使 条 件 概率 密度 p(z | x) 达到 极 大 的 那个 x 值 作为 最 优 估计 
值 。 显然, 为 了 求 得 极 大 似 然 估计 ,需要 知道 条 件 概率 密度 p(z | x), 

6) 极 大 验 后 估计 

极 大 验 后 估计 是 使 条 件 概率 密度 p(x | z) 达到 极 大 的 那个 x 值 作为 最 优 估 计 
值 。 显然 ,为 了 求 得 极 大 验 后 估计 ,需要 知道 条 件 概率 密度 p(x | z) 。 
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可 以 看 出 ,要 解决 最 优 估计 问题 ,必须 要 具备 足够 的 统计 信息 。 例 如 ,对 于 线性 
最 小 方差 估计 ,使 用 随机 变量 x 和 z 的 最 多 二 阶 统计 特性 (包括 均值 .相关 函数 和 方 
差 ) 就 足以 求 出 最 小 均 方 误差 估计 。 


3.2 最 小 二 乘 估计 


最 小 二 乘 估计 法 是 由 德国 数学 家 高 斯 提出 的 。 古 典 的 最 小 二 乘 估计 只 是 残 差 
平方 和 达到 极 小 意义 下 的 一 个 估计 ,属于 线性 无 偏 估计 ,但 一 般 不 是 线性 最 小 方差 
估计 。 上 古典 的 最 小 二 乘 估计 是 把 所 有 的 观测 量 放 在 一 起 处 理 , 随 着 递 推 滤波 的 发 
展 ,又 出 现 了 最 小 二 乘 的 递 推 形式 ,可 以 逐步 递 推 ,也 可 以 分 段 递 推 。 古 典 的 最 小 二 
乘 是 无 初始 估计 的 ;对 于 有 初始 估计 的 情况 ,在 一 定 条 件 下 ,这 种 估计 等 价 于 卡尔 曼 
滤波 估计 。 


3.2.1 古典 最 小 二 乘 估计 


为 了 估计 未 知 量 X, 对 其 进行 了 xm 次 测量 ,假设 每 个 测量 量 可 以 表示 为 状态 量 
的 线性 函数 , 即 
Z, = hatı +hazy + hizi, Vivi = 1,2,° ,mMm (3.2.1) 
RP, hy G = 1,2,…,n) 为 已 知 量 , vi 为 第 i 次 测量 误差 , 记 H, = [ha shes sha], 
名 为 XX 的 估计 值 , 则 第 i 次 测量 2; SHEHER ZAA 
ë, = Z, — HÊ (3.2. 2) 
最 小 二 乘 准 则 就 是 希望 所 求 的 估计 值 多 能 使 误差 ë, 的 平方 和 达到 极 小 ,即使 性 
能 指标 


J® = >; (Z, — H.R)’ (3.2.3) 
i=1 


达到 极 小 的 估计 值 X, 记 作 Ris. 
将 式 (3. 2. 1) 和 式 (3. 2. 3) 表 示 为 向 量 形式 , 即 


Z= HX+V (3.2.4) 
J& = (Z— HX)T™(Z— HX) (3. 2.5) 
其 中 ,测量 误差 了 是 均值 为 0 且 方 差 为 尺 的 随机 向 量 , 即 
EV =0 
ECVVT) =R 
AEJ R 取 极 小 , 令 
IV o 


* 66 + 最 优 估计 理论 





得 —2H"(Z— HÅ) |s-%s 一 0 
即 K. = (H'Hy'H'Z G3.2.6) 


再 由 ardo = 2H"H > 0 可知 , 式 (3. 2. 6) 得 到 的 估计 值 即 为 最 小 二 乘 估计 。 
显然 ,最 小 二 乘 估计 名 s 是 测量 值 2 的 线性 函数 , 即 线性 估计 。 


估计 误差 
Š= X— Xs 
= (H'H>'HTHX — (H'H>-'H'Z San 
= (H"H) `H" (HX — Z) 
=— (H"H) ` H"V 
估计 误差 的 期 望 值 


E(KX.s)= E[— (H"H) H'V] 
=— (HIH) 1HTE(V) (3.2. 8) 
一 0 
RC. 2, 8) 表明, 估计 误差 均值 为 0, 即 随机 量 的 均值 与 其 估计 量 的 均值 相等 , 称 这 种 
估计 为 无 偏 估计 。 因 此 , 当 测 量 误差 的 均值 为 0 时 ,最 小 二 乘 估计 是 无 偏 估计 。 
此 时 ,估计 误差 方差 阵 Var( 灸 ) 与 估计 量 的 均 方 误差 阵 ELX — XJ [x AT" 相 
等 。 这 是 因为 
Var(Xis)= E[ Xs — EC(X.s)J[ X,s — E(K.s) Jr 
= E(X ıs is) 
以 及 
E[X—s][X — KT = EC(X.sXIs) 
即 对 于 无 偏 估 计 , 均 可 以 将 其 均 方 误差 阵 称 为 估计 误差 方差 阵 。 
下 面 计算 最 小 二 乘 估计 误差 方差 阵 ; 
Var(KX.s)= E(X.s XIs) 
= E[X— ER) [X ERs] 
= (H"H) H"E(VV")H(H"H)™ 
= (H"H) ` H"RH (H: H> 
Var(X is) 刻画 了 估计 误差 X.s 分 布 在 “0 附近 的 密集 程度 , Var Kis) 越 小 ,说 
BJ 名 s 越 接近 X, 估计 精度 越 高 。 
性 能 指标 的 极 小 值 为 
JŠ) = Z [I— H (HTH) HT H (HEH H"]Z (3. 2,10) 


(3. 2. 9) 
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JC) 与 估计 误差 方差 阵 Var Ri) 是 两 个 不 同 的 概念 ,最 小 二 乘 估计 只 是 保 
证 测量 值 与 估计 值 之 差 的 平方 和 最 小 ,并 不 保证 估计 误差 的 方差 最 小 。 

由 最 小 二 乘 原理 可 知 ,如 只 需求 最 小 二 乘 估计 量 Xs, 则 不 需要 随机 变量 V 的 任 
何 统计 信息 。 

例 3.1 假设 二 维 向 量 X 的 三 次 测量 结果 为 


wr: 


解 由 式 (3.2.6) 得 
Åıs= CHTEHED)-LHTZ 


3.2.2 ”加权 最 小 二 乘 估计 


在 最 小 二 乘 估计 中 ,假定 每 次 测量 对 估计 结果 的 影响 程度 相同 。 但 实际 上 ,各 
次 的 测量 数据 不 应 同等 看 待 ,而 是 对 于 测量 数据 所 加 的 权 ( 即 重视 程度 ) 应 与 该 次 测 
量 误差 的 方差 成 反比 , 即 对 于 测量 误差 方差 小 的 数据 应 加 更 大 的 权 , 反 之 亦 然 。 

在 加 权 的 情况 下 ,最 小 二 乘 估计 的 误差 平方 和 为 

Jy (K) = (Z 一 HR)TWCZ 一 HE) (3. 2.11) 

式 中 , W 是 适当 选取 的 正定 加 权 阵 , 当 W = 工时 ,加 权 最 小 二 乘 估计 退化 为 一 般 的 最 
小 二 乘 估计 。 

将 性 能 指标 函数 Jy CK) 对 估计 量 训 求 偏 导 , 得 


am =—2H'W(Z — HX) (3.2. 12) 


为 使 Jv CO 取 极 小 , 令 asco 二 0, 得 
Ksw = (HWH)T HWZ (3. 2. 13) 
注意 到 sano = 0 只 是 式 (3. 2. 13) 为 最 小 二 乘 估计 的 必要 非 充分 条 件 ,而 且 加 权 


BE W 也 是 未 知 的 。 为 使 式 (3. 2. 13) 确 实 是 X 的 最 小 二 乘 估计 ,下 面 求 其 估计 误差 
方差 ,通过 使 其 最 小 来 寻求 最 优 加 权 阵 WW。 

为 方便 以 下 的 证 明 ,首先 引入 许 瓦 芯 不 等 式 。 设 A 和 B 分 别 为 xXm 和 m Xi 的 
矩阵 , 且 AAT 为 可 逆 阵 , 则 
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BTB > (4B)T (AA™)™ (AB) (8.2. 14) 
RG. 2. 14) 称 为 许 瓦 茨 不 等 式 。 
RRG. 2. 13) 求 得 估计 值 的 误差 方差 阵 为 
Var(X — K.sw)= E(X sw) Kisw 
= (H'WH) -HIWE (VV OWH (H"WH )™ 
= (H'WH) 'H'WRWH (H'WH)`1 (8.2.15) 
由 于 测量 误差 方差 矩阵 R 是 正定 的 ,可 以 表示 为 
R=C'C 
RH, C 为 可 逆 矩 阵 。 此 时 
Var(X — Šısw) = [OWH (H"WH) 1TJ![CWH (H'WH)`1J 
4 A = H'C™ ‚B = OWH (HTWH) 一 ,由 许 瓦 蒋 不 等 式 得 
Var(X— Šısw)= B"B > (AB)T (AAT) 1 (AB) 
=[H'R H] 
方差 矩阵 Var(X — Row) 的 极 小 值 显然 在 上 述 不 等 式 取 等 号 时 成 立 , 即 取 W = 
R 时 。 此 时 ,估计 值 和 估计 误差 方差 为 
isw = (HIRD HTR'Z (3. 2. 16) 
Var(X — K.sw) = (H'R-: H) G3. 2.17) 
显然 ,对 于 线性 系统 , 当 残 差 平方 和 中 取 最 优 加 权 阵 W = RK， 时 ,最 小 二 乘 估计 
是 缺少 初 值 条 件 下 的 线性 无 偏 最 小 方差 估计 。 这 种 取 最 优 加 权 的 最 小 二 乘 估计 又 
称 为 马尔 可 夫 估 计 。 
前 面 已 假定 测量 噪声 V 的 均值 为 0, 已 知 方差 为 R。 实际 上 ,对 于 一 般 的 最 小 二 
乘 估计 ,并 不 假定 测量 噪声 有 任何 统计 特性 。 显 然 , 在 测量 噪声 统计 特性 未 知 的 情 
况 下 ,最 小 二 乘 估计 只 是 一 个 线性 估计 ,而 未 必 是 最 小 方差 估计 了 。 
加 权 最 小 二 乘 估计 优 于 普通 的 最 小 二 乘 估计 ,但 它 需 要 测量 误差 方差 阵 的 信息 。 
前 面 介 绍 的 一 般 最 小 二 乘 估计 和 加 权 最 小 二 乘 估计 均 为 批 估 计 方 法 , 即 在 获得 
一 批 数据 以 后 再 集中 处 理 的 方法 。 这 个 方法 不 仅 占用 计算 机 大 量 的 内 存 , 而 且 不 能 
用 于 在 线 估计 。 这 个 问题 的 解决 方法 是 采用 最 小 二 乘 估计 的 递 推算 法 。 
3.2.3 递 推 最 小 二 乘 估计 


递 推 最 小 二 乘 估计 能 够 实现 的 是 :在 获得 新 的 观测 ze 后 ,利用 Ris e) 和 新 观 
测 获得 X, HR RIH Ris kH. 
假定 对 n ERARA 进行 了 次 测量 ,构成 向 量 方程 为 
Z, = H,X +V, 
AH, Z, 为 全 部 次 测量 值 构成 的 向 量 , H, 为 上 X n EER, V, 为 & 维 测量 误差 向 
量 ,其 方差 为 阶 正定 阵 R。。 
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根据 式 (3. 2. 16) ,得 加 权 最 小 二 乘 估计 为 
sw lk) = LEBEREET !HIR;'Z, 
根据 式 (3. 2. 17) ,得 估计 误差 方差 阵 为 
P, = EUX sw (k) XIsw (k)] = [HIRZ'H,T" 
利用 上 式 ,加权 最 小 二 乘 估计 值 可 以 表 款 为 
Ksw lk) = P,HIR;'Z, 


(3. 2. 18) 


(3. 2. 19) 


(8. 2. 20) 


(3. 2. 21) 


(8. 2. 22) 


(3. 2. 23) 


(3.2. 24) 


现 假 定 又 得 到 第 十 1 次 测量 值 为 
zen 一 H, X + ve 
则 全 部 十 1 次 测量 值 构 成 的 向 量 方程 为 
Zn = Hm X +V 
由 此 ,得 新 的 估计 为 
< Ksw k+ D= [Hin 十 Re H, , HE Rih Ze 
ka P, a Hina Rih Zen P 
RP, Pm = [HR Hn] Rh 是 关于 全 部 & 十 1 次 测量 的 新 的 加 权 阵 , 且 有 
R? 0 
Rh = [ 0 sl 


于 是 


1 H, 
HhRhBa= [HE P J S J: | 

0 Tei 
= MERT H, + hfa rih hen 

由 式 (3. 2. 19) 得 

Pih = Pi + hfa rihh 
或 

Pin = [PR + hlarihhen 





进而 得 
Pn = P, — Phb [heaPihh + ren Jh P, 
由 式 (3. 2. 23) 和 (3. 2. 24) 得 
高 sw( 十 1) 一 P, Hi Rih Zen 
= Pon LER? Z, + hiara zen] 
由 式 (3. 2. 20) 知 
HER? Z, = P?’ Å sw (k) 
再 由 式 (3. 2. 26) 得 
HEREZ: = [Pih — hha rih he Risw (k) 


(3. 2. 25) 


(3. 2. 26) 


(3. 2. 27) 


(3. 2. 28) 


(8. 2. 29) 
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将 上 式 代入 式 (3. 2. 29) 得 
Ksw (k + D= Pn Hina Rh Zen 
= K.sw (k) +Pinhfarrh Cr — hingsw(k)] (3. 2. 30) 
= K.sw (k) + Ken [zi — hen Kisw (k) ] 


式 中 ， 
Ken = Puhbarid (3. 2. 31) 
RC. 2. 28)、(3. 2. 30) 和 (3, 2. 31) 构 成 了 加 权 最 小 二 乘 递 推 估计 算法 
Pin = P; — Piha Chen Pih En + ren Jhen Pa 
Kin = Penhinrih | (8.2. 32) 
K.sw (k +1) = Ñ.sw (k) 十 Ka[zrh — hin K.sw (k) J 


式 (3. 2.32) 表 明 ,新 的 估计 Kw (k + 1) 是 由 旧 估 计 Kw Gk) 与 修正 项 组 成 ,而 
修正 项 正比 于 新 的 测量 值 与 测量 估计 值 之 差 ,这 相当 于 带 有 反馈 校正 的 性 质 , 即 当 
新 测量 值 与 测量 估计 值 不 符 时 ,就 用 它们 之 差 修正 估计 量 , 这 也 是 递 推 估计 的 重要 
特点 。 


3.3 ”最 小 方差 估计 和 线性 最 小 方差 估计 


3.3.1 最 小 方差 估计 


衡量 一 个 估计 量 的 优 劣 ,应 该 研究 其 估计 误差 的 全 部 统计 规律 ,而 均 方 误差 阵 
正 是 表征 估计 误差 在 零 附 近 密集 程度 的 一 个 标志 ,可 用 它 来 描述 估计 的 精确 程度 。 
最 小 方差 估计 就 是 使 估计 均 方 误差 阵 最 小 的 估计 。 
估计 误差 均 方 误差 阵 为 
ERX = E[x— (Z) [x — &(Z2) Jr 
= [T soa f” t 一 他 (z)] [z — 2(2)] f(z | z)dz 
式 中 , Z) 是 处 的 估计 量 ,是 Z 的 函数 ; f(z) 是 ZZ 的 概率 密度 函数 ; f(z | z) 是 给 
SE Z = x 的 条 件 下 , X 的 条 件 密 度 函数 。 
最 小 方差 估计 就 是 使 式 (3. 3. 1) 取 极 小 的 估计 。 使 ERE 取 极 小 实际 上 是 使 
ECX K) 极 小 。 令 
J.GO= ERR) 
= reoas |” -Ff | àz 
由 于 f(z) 是 非 负 的 ,所 以 式 (3. 3. 2) 取 极 小 等 价 于 式 (3. 3. 3) 取 极 小 , 即 


〈3. 3. 1) 


(3. 3. 2) 
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JGD= Í [一 io][z 一 so]FGz | de 
= E(X' X | Z) —2K'(Z)EC(X | Z) + X' (Z) (Z) 


(3. 3. 3) 


少 


ID o 
ə& 


—2E(X | Z) + 2K(Z) = 0 


即 š 
X(Z) = E(X | Z) (3.3.4) 


式 (3. 3.4) 表 明 , 最 小 方差 估计 等 于 在 给 定 Z 二 = 的 条 件 下 于 的 条 件 均值 。 
此 外 ,还 有 


ELXC2)]= |” EX | 22 f(z)de 
= Ë ([ re l Ddod) fde 
=[ [ra | 9 reoas]az 


= F [f fedeli 

= f? afde 

= Ex 
显然 ,最 小 方差 估计 还 是 无 偏 估计 。 

一 般 来 说 ,最 小 方差 估计 的 误差 方差 阵 要 小 于 线性 最 小 方差 估计 的 误差 方差 

阵 。 但 是 ,最 小 方差 估计 需要 知道 被 估计 量 X 及 测量 量 Z 的 联合 概率 分 布 ,但 这 一 
点 在 很 多 情况 下 做 不 到 。 当 和 Z 的 联合 分 布 服从 正 态 分 布 时 ,最 小 方差 估计 
RD) = EX | Z) 是 Z 的 线性 函数 。 在 这 种 情况 下 ,最 小 方差 估计 就 是 线性 最 小 方 
差 估计 ,因为 无 偏 最 小 方差 估计 未 必 是 线性 估计 。 因 此 ,线性 无 偏 最 小 方差 估计 一 
般 不 是 均 方 意义 下 的 最 优 估 计 。 


3.3.2 线性 最 小 方差 估计 


线性 最 小 方差 估计 是 一 种 特殊 的 最 小 方差 估计 , 它 是 指 估计 量 是 测量 量 的 线性 
函数 ,并 使 估计 的 均 方 误差 达到 极 小 的 估计 , 即 估计 量具 有 如 下 形式 
R =a+BZ (3. 3. 6) 
式 中 , a 是 与 被 估计 量 X 同 维 数 的 随机 向 量 , B 是 其 行 数 等 于 被 估计 量 X 的 维 数 , 列 
数 等 于 测量 量 Z 的 维 数 的 矩阵 。 


(3. 3. 5) 
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性 能 指标 为 均 方 误差 阵 , 即 
J@p= ELX 一 各 [X 一 各 
= E[X—a— BZI[X—a— BZ)" 
BEE J O 取 极 小 的 a 和 B 分 别 为 ar 和 Bi， 由 极 值 理论 可 求 得 
a, = EX — Cov(X,Z) [ Var(Z) J! EZ 
B. = Cov(X,Z) [ Var(Z) T! 
从 而 得 线性 最 小 方差 估计 为 
X.= a, + B.Z 
= EX + Cov(X,Z)[ Var(Z)J-: (Z — EZ) 
EXL= a, + B.,Z 
= EX + Cov(X,Z)[ Var(Z) J! (EZ — EZ) (3. 3. 9) 
= EX 
式 (3. 3. 9 说 明 , 线 性 最 小 方差 估计 是 无 偏 估计 。 
线性 最 小 方差 估计 的 估计 误差 为 
X— Å, = (X— EX) — Cov(X,Z) [ Var(Z)J-1(Z— EZ) (3.3.10) 
继而 得 估计 误差 与 测量 残 差 的 协 方差 为 
E(X — K.) (Z— EZ)" 
= E(X— EX)(Z— EZ)" — Cov(X,2Z)[ Var(Z)J! E(Z— EZ)(Z — EZ)" 
= Cov(X,Z) — Cov(X,Z) Var(2) ' Var(Z) 
= Cov(X,Z) — Cov(X,Z) = 0 


(3.3.7) 


G3.3.8) 


(8.3.11) 
AG. 3. 11) 说 明 , 随 机 向 量 X, 二 XX 一 名 与 Z 是 不 相关 的 。 从 几何 的 角度 看 ,不 
相关 即 正 交 。 于 是 ,多 与 已 是 正 交 的 ,可 以 说 总 , 是 尺 在 由 也 的 各 个 分 量 所 组 成 的 
线性 子 空间 上 的 投影 。 
线性 最 小 方差 估计 的 均 方 误差 阵 为 
J(&.)= E(x — &.)(x — Â)" 
= Var(X) — Cov(X,Z) — Cov(X,Z) Var(Z) 1Cov(Z,X) 
(8.3.12) 
例 3.2 对 某 一 未 知 随机 向 量 X 的 测量 是 线性 的 , 即 测量 方程 为 
Z=HX+V 
HH EX = p, EV = 0,Var(X) = P,Cov(X,V) = 0, 试 求 X 的 线性 最 小 方差 估计 。 
f EZ = HEX = Hy. 
Var(D)= E(Z— EZ)(Z— FZ)" 
= E[H(X— p) +VJ[H(X— p) +V 
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加 r. LT 
= HE (X — p) (X— p)" H’ + EVV" od 


= HPHT+R 
Cov(X,Z)= E(X —,)[Z — EZ]" 
= E(X — p) [H(X — p) 十 V]T (3. 3. 14) 
= PHT 
于 是 得 发 的 线性 最 小 方差 估计 为 
K. =EX + Cov(X,Z)[Var(Z)J 1 (Z — EZ) asis 
= p +PH'[HPH" + R] 1 (Z— Hp) ir 
均 方 误差 阵 为 
EX.XI= E(X— 8) XR)" 
= P— PH" (HPH" + R)! HP (3. 3. 16) 


= (P> + H"R`H)” 
在 上 节 讨 论 加 权 最 小 二 乘 估计 时 ,已 经 得 到 结论 :如 取 加 权 阵 W =R, 则 所 得 
均 方 误差 最 小 。 将 式 (3. 2. 19) 与 式 (3. 3. 16) 比较 ,由 于 也 为 非 负 定 阵 , 故 线性 最 小 
方差 估计 比 加 权 最 小 二 乘 估 计 及 最 小 二 乘 估计 获得 了 更 高 精度 的 估计 结果 。 
线性 最 小 方差 估计 也 可 以 递 推 实现 。 假 设 被 估计 量 X 的 线性 最 小 方差 估计 的 
递 推 公式 为 


K, = K, 十 Ke [ze — Cn ka] (3. 3.17) 
式 中 , zi 为 第 十 1 次 测量 值 , 且 有 
zen = Cn X + vn (3. 3. 18) 


式 中 , Ctn 为 已 知 的 向 量 , ven 为 测量 误差 ,考虑 到 每 次 测量 值 之 间 的 独立 性 , 故 认为 
wmon = 0,1,2,… 为 白色 序列 。 Ker 为 待定 的 增益 矩阵 。 
HRC. 3. 17) 得 估计 误差 


X, a= X—K,, = X- R 一 Kn[za 一 Cm 总] 
外 一 名 一 Kun[CinXX 十 vn —C,..K,J 
= [I—Ka Cn [X — R] + Ken ven 
= [I— Kn Cin ]K, + Ken ven 
X, Xia = [I— Kn Cn JX,X7[I— Ken Cn J" 
— Kven KILI — Ken Ca, JY 
UKn C JX, Ke 


+ Kven vin KE 
由 于 w 为 白色 序列 ,所 以 有 


E{Knvn KI [I— Ke iC, i T!) = 0 

















(8.3.19) 


(3. 3. 20) 
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E{[I— KC Xb Kl} = 0 
于 是 ,估计 误差 均 方 误差 阵 为 
Pin = E(X, Rha) 
= [I—KaCa JE(X,XDLI KnCen Jt (8.3. 2) 
+ Kn Eor vin KË 
= [I — Krn Cen JP,[I— K. Cin J! HRe Ren Kin 
选择 合适 的 增益 矩阵 Ks, 使 估计 误差 Xen 每 个 分 量 的 方差 都 达到 最 小 值 ,这 
相当 于 使 矩阵 P 对 角 线 的 每 个 元 素 都 达到 最 小 值 。 
将 式 (3. 3. 21) 展 开 , 同 时 加 减 
PCH (CPiCh HRe) Cen Pe 
再 对 结果 进行 整理 ,得 
Pin =P — PiChi [CnPCh + Ren C; P, 
+ [Kn — PiCh (CPiCh + Ra) [Cn PCi + Ra] 
X [Krn — PiCHn (Cn PiChn Ren)’ ] 
(3. 3. 22) 
式 (3, 3. 22) 中 ,为 使 Pu 最 小 ,只 需 选择 K. , 使 
Kn —PCh (C, P,Chi 十 Re 一 0 


即 
Ken = PCH (Crn PCh HRe) (3. 3. 23) 


将 式 (3. 3. 23) 代 人 式 (3. 3. 22) ,得 
Pt 一 严 一 PCH[LCHPACEH 十 Re Crn Pe 
= P, — Kon C, P, (3. 3. 24) 
= UKn Cn JP, 
综 上 ,线性 最 小 方差 的 递 推 估计 公式 为 
K, = X, +K. [z, Onk] 
< = PCh (Cin PiCh 十 Re 一 (3. 3. 25) 
Pin = [I — Kn Cin JP, 
即 在 获得 新 的 测量 值 时 , 原 有 估计 K, 与 差 值 (z,, 一 Com 名) 的 加 权 和 构成 反馈 校正 
项 。 因 此 , 随 着 测量 次 数 的 增多 ,在 线 估计 值 Kn 的 准确 度 会 越 来 越 高 。 


3.4” 极 大 似 然 估计 和 极 大 验 后 估计 


前 面 讨论 了 根据 其 他 随机 变量 (向 量 ) 对 另 一 个 随机 变量 (向 量 ) 进 行 估计 的 问 
题 。 但 实际 上 ,许多 问题 涉及 的 待 估计 变量 不 是 随机 变量 ,而 是 确定 的 值 或 参数 。 
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在 这 种 情况 下 ,需要 考虑 非 随机 参数 估计 方法 ,常见 的 有 极 大 似 然 估计 法 和 极 大 
验 后 估计 法 。 
3.4.1 极 大 似 然 估计 

极 大 似 然 (Maximum Likelihood) 估 计 是 以 观测 值 出 现 的 概率 最 大 作为 估计 准 
则 方法 。 

设 观测 变量 = 是 一 维 的 连续 随机 变量 ,其 概率 密度 函数 为 p(z, 负 ,82，,…,0,), 含 
有 个 未 知 参数 01, 如 ,…,6,。 把 个 独立 观测 值 = ,zs，…,zi 分 别 代 人 Pbs 


鲍 …,0,) 中 的 z, 则 得 
力 (ziy0，0 0) 人 一 12 


将 所 得 的 & 个 概率 密度 函数 相 乘 ,得 
k 
L(zozao o z300 0.) = [[ plzi,0, ,0 ,0,) (3.4.1) 
i=l 
称 函数 工 为 似 然 函数 。 当 zi ,z,，,…,z MÆR, 工 是 91,0,，…,0, 的 函数 。 极 大 似 然 
估计 的 实质 是 求 出 使 工 达到 极 大 时 ,bp. ,2.，…,6, 的 估 值 全 ,名 ，…0,。 由 式 (3.4.1) 
可 以 看 出 , 0 0, 是 观测 值 = ,zs，…,z 的 函数 。 
为 了 便于 求 出 使 工 达 到 极 大 的 6 ,2 0,, 对 式 (3. 4. 1) 左 右 两 端 取 对 数 , 得 
lnL = Ti moc ,00 ,0,)] (3.4.2) 


puan unyiq am, 因此 当 工 取 极 大 时 ,将 式 (3. 4. 2) 分 别 对 9， 
rO 求 偏 导数 , 令 偏 导数 等 于 0, 可 得 下 列 方程 组 


-9_lnl = 
a L = 0 
i (3.4.3) 
= IL = 
aL = 0 


解 上 述 方程 组 , 即 可 得 使 二 达到 极 大 时 的 让 ,2 ,6 
可 以 看 出 , 按 极 大 似 然 估 计 法 确定 久 0, ,，…, 六 ,使 ma ,zz 最 优 可 能 出 现 ， 
并 不 需要 4 0, ，…,6, 的 验 前 知识 , 即 无 需 了 解 0. ,2 ,…,b, 的 概率 密度 函数 和 一 阶 和 矩 
和 二 阶 矩 。 
设 z 为 m 维 随机 变量 , x 为 n 维 未 知 参数 ,假定 已 知 z 的 条 件 概率 密度 函数 为 
DC | x), 现 得 到 组 z 的 观测 值 z1 z "zao 且 各 观测 值 相互 独立 。 为 确定 使 z, 
ze" z, 出 现 可 能 性 最 大 时 的 参数 x, 首先 确定 似 然 函 数 
L(z,x) = plz | Ople | xz)… 力 (ze | x) = plz | x) (3.4. 4) 
或 
In[L(z,x)] = In[ (z | x)] (3.4.5) 
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求 出 使 工 极 大 的 x 值 , 令 


Log 
ak = o a PEL 一 0 (3. 4.6) 


解 之 ,可 得 x Ee, 
注意 , L 取 极 大 值 的 充分 条 件 是 
oL_ lnL _ 
ae TIRa T? 


因此 ,用 极 大 似 然 法 时 ,应 先 求 似 然 函数 工 , 再 用 微分 法 求 出 使 似 然 函 数 工 极 大 时 x 
WHE S. 

340882 x 的 验 前 概率 密度 时 , 极 大 验 后 估计 与 极 大 似 然 估 计 是 等 同 的 。 一 般 来 
说 ,由 于 计算 似 然 函数 比 计算 验 后 概率 密度 较为 简单 , 极 大 似 然 估 计 法 比 极 大 验 后 
估计 法 应 用 普遍 。 

例 3.3 设 有 一 随机 线性 观测 系统 

z=h(x,v) = Hx +v 

式 中 , z Ë m 维 观测 值 , x 是 维 位 置 参 数 , o 是 m 维 测量 误差 ,是 零 均值 的 高 斯 过 
程 , 且 方 差 为 E(ww 7) = R. 假设 x 与 v 独立 , 求 x 的 极 大 似 然 估 计 。 

首先 定义 似 然 函 数 

L(z,x) = p(z | x) = pz) 


plx) 
考虑 到 xz Ej o 相互 独立 ,可 得 
力 (xyz) = p[x, (Hx +v)] = p(x,o) = p(x)p(v) 


— p(x)plv) Pe 
L(z,x) PCr) plo) = p(z — Hx) 








令 ƏLG,x) opl(z—Hx) _ ç 
adx ax 
由 已 知 
= 1 mail 
pw) 一 Z" Ral 2 vR?’ v) 


将 v=z 一 Hx 代 人 上 式 ,得 
Lax) = p(z— Hx) = c * exp| — + G — HoR? (z — Hx) | 











m Zh. =s 
ai CZE" [RI 
3R x, {Ë L(z,x) = p(z — Hx) 最 大 , 即 
J = G— HoR? G — Hx) = min 
求 了 对 x 的 偏 导数 , 令 偏 导数 等 于 0, 即 
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SI — HR s-- H'R''Hx 一 0 
可 得 H':R Hx = H'R z 


求 得 x 的 估 值 * 为 
£= (H'R` H)’ H'R”z 


3.4.2 极 大 验 后 估计 


如 果 给 出 维 随机 变量 x 的 条 件 概率 密度 pC | x), 即 验 后 概率 密度 ,如 何 求 x 
的 最 优 估 值 * ? 这 种 情况 下 ,可 以 采用 极 大 验 后 (Maximum a Posterior) 估 计 准 则 ， 
使 x 的 验 后 概率 密度 p(x | z) 达到 最 大 的 值 为 极 大 验 后 估计 立 。 
极 大 验 后 估计 法 是 以 了 解 p(x | z) 为 前 提 的 。 如 果 只 知道 pCz | xz)， 可 如 此 计 
W plx | z), 即 
plx | z) = zaloga (3.4.7) 


AH, p(x) 是 x 的 验 前 概率 密度 函数 , p(z) 是 观测 值 z 的 概率 密度 , p(z | x) 可 用 
计算 方法 或 实验 方法 求 得 。 为 了 计算 p(x | z), 需要 知道 pa), 在 x 没有 验 前 知识 
可 供 利 用 时 ,可 假定 x 在 很 大 范围 内 变化 。 在 这 种 情况 下 ,可 把 x 的 验 前 概率 密度 
b (x) 近似 地 看 做 方差 矩阵 趋 于 无 限 大 时 的 正 态 分 布 密度 函数 , 即 


exp[ $x m) PCa m.) | 








1 
(x) r 
f Vm)" |R 


式 中 , P 为 x 的 方差 矩阵 , P— o, P — 0, 于 是 
WEA] == MEV" | p|'2J— mP (x —m.) 


Žiga) =— P> (x—m,) (3. 4. 8) 
4 P 一 0 时 ,有 
名 ln[p(x)] =0 (3.4.9) 
HZ x 的 验 前 概率 密度 时 , 极 大 验 后 估计 与 极 大 似 然 估计 是 等 同 的 ,证 明 
如 下 : 
对 于 极 大 似 然 估计 ,为 了 求 得 x 的 最 优 估 值 让, 令 
alnet | x)] a (3.4.10) 


根据 式 (3. 4. 7) ,得 
In[ P(x | z)] = In[ P(z | x)]+ In[ p(x)] — In[ p(z)J 
Əln[p(x | z) J _ Əln[ pl | x)] , Əl] __əln[p(z)J 
ax ax F Bx Br 0 (3.4.11) 
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考虑 到 p(z) 不 是 x 的 函数 ,同时 考虑 到 式 (3. 4.9) ,可 得 
Bln[plx | z)]J _ Əin[p(z | x) J (3.4.12) 
əx ax nor 


一 般 来 说 ,由 于 计算 似 然 函 数 比 计算 验 后 概率 密度 较为 简单 ,因此 极 大 似 然 估 
计 法 比 极 大 验 后 估计 法 应 用 普遍 。 








思 考题 


3-1 设 对 未 知 标量 z 进行 了 6 次 测量 ,测量 方程 为 


3 e; 
5 e 


EXI e; 独立 , Ele] = 0,Var[e] = 0, 求 最 小 二 乘 估计 、 最 优 加 权 最 小 二 乘 估 计 及 其 估计 误差 
方差 。 
3-2 ”观测 值 x 和 观测 时 刻 #* 如 下 表 所 示 。 设 fO) = m + mt, 用 最 小 二 乘法 确定 一 和 zy。 
as | 2 4 5 [ 8 9 


Zi 2.01 2. 98 | 3.50 | 5.02 | 5.47 











3-3” 设 线性 矢量 观测 方程 为 z= 二 Hx 十 v ,其 中 x 为 NX1 维 矢量 ,z 和 噪声 0 为 mX1 维 矢量 ， 
互 为 MXN 维 测量 矩阵 ,假定 So 独立 , 且 均 为 高 斯 分 布 , 求 最 小 方差 估计 主 。 


3⁄4 设 有 一 离散 概率 分 布 情 况 如 下 : 若 测量 值 = 一 一 1, 有 P( 一 1) = Pro = $ 其 他 为 
0; 若 测量 值 > 一 0, 有 PO) = EPO 一 È, 其 他 为 0; 若 测量 值 z 一 1, 有 PO) = 而 ,P(2) = 


T: 其 他 为 0。 求 线性 最 小 方差 估计 s, 


3-5 设 x 是 n 维 随机 向 量 , 且 满足 分 布 Nu,P)。z = Hx 十 0 为 m 维 观测 值 ,其 中 v 为 m 维 测 
量 噪声 , 且 满 足 分 布 N(0,R) ,x 与 ov 相互 独立 , 求 z 的 极 大 似 然 估计 ev (z) 。 

36 设 有 测量 值 x =r +0 i 二 1,2,…,N, 其 中 之 和 6; 均 为 高 斯 分 布 ,互相 独立 ,噪声 的 
分 布 为 N(D, 史 ),z 的 分 布 为 N(0, 避 ), 求 极 大 后 验 估计 $... 。 
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内 容 提要 首先 介绍 线性 连续 系统 的 维 纳 滤波 原理 ,利用 变 分 法 导出 维 纳 - 霍 夫 
方程 ;然后 分 别 采 用 频谱 因 式 分 解法 和 伯 德 -香农 法 讨论 维 纳 - 霍 夫 方 程 的 求解 问题 
最 后 介绍 线性 离散 系统 的 维 纳 滤 波 。 


维 纳 滤波 是 20 世纪 40 年 代 在 线性 滤波 理论 方面 取得 的 最 重要 成 果 ,由 美国 科学 
家 维 纳 (Wiener) 在 解决 对 空 射 击 的 控制 问题 时 所 建立 ,是 一 种 利用 平稳 随机 过 程 的 相 
关 特 性 和 频谱 特性 对 混 有 噪声 信号 进行 滤波 的 方法 。 维 纳 滤波 是 在 信号 和 干扰 都 存在 
有 理 谱 密度 的 情况 下 求 出 最 优 滤波 器 ,使 得 系统 的 实际 输出 与 希望 输出 之 间 的 均 方 误 
差 最 小 。 维 纳 滤波 的 实质 是 推导 出 维 纳 - 霍 夫 积 分 (Wiener-Hopf) 方 程 ,求解 这 一 方程 
可 得 最 优 滤波 器 的 脉冲 过 渡 函 数 ,再 由 过 渡 函 数 得 滤波 器 的 传递 函数 。 


4.1 线性 连续 系统 维 纳 滤波 原理 


4.1.1 滤波 问题 的 提出 


在 工程 实际 中 ,随机 信号 或 随机 过 程 是 普遍 存在 的 。 一 方面 ,任何 确定 信号 经 
过 测量 后 往往 会 引入 随机 误差 而 使 该 信号 随机 化 ; 另 一 方面 ,任何 信号 本 身 都 存在 
随机 干扰 。 干 扰 可 以 是 确定 信号 ,如 国内 的 50Hz 工 频 干 扰 , 也 可 以 是 随机 噪声 。 任 
何 随机 信号 都 可 看 做 是 纯 随机 信号 与 确定 信号 并 存 的 混合 随机 信号 。 因 此 ,需要 寻 
找 一 种 最 佳 滤波 器 , 当 信号 和 干扰 及 随机 噪声 同时 输入 该 滤波 器 时 ,在 输出 端 能 将 
信号 尽 可 能 精确 地 复 现 出 来 。 

假设 测量 装置 测 得 的 信号 =(z) 包含 了 有 用 信号 z(t) 和 随机 干扰 信号 va). H 
了 从 混 有 噪声 的 信号 z(t) 中 提取 出 有 用 信号 zG), 通常 的 做 法 是 通过 设计 滤波 器 
的 传递 函数 G(s) , 使 其 输出 信号 +G) 尽 可 能 精确 地 复 现 出 有 用 信和 号 z(z), 同时 又 
尽 可 能 多 地 将 干扰 信号 v(z) 滤 掉 , 则 上 述 问题 称 为 最 优 滤波 问题 。 

如 果 所 设计 的 滤波 器 传递 函数 G(s) , 使 其 在 上 时 刻 的 输出 信号 人 (2) 尽 可 能 精确 
地 复 现 出 上 十 rz 时 刻 的 有 用 信号 zG + zr) , 则 时 又 尽 可 能 多 地 将 干扰 信号 va) 滤 掉 ， 
则 上 述 问题 称 为 最 优 预测 问题 。 

如 果 所 设计 的 滤波 器 传递 函数 Gs) , 使 其 在 t 时 刻 的 输出 信号 (2) 尽 可 能 精确 
地 复 现 出 上 十 = 时 刻 有 用 信号 的 导数 O, 同时 又 尽 可 能 多 地 将 干扰 信号 v) 滤 
掉 , 则 上 述 问题 称 为 微分 平滑 问题 。 
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信和 号 流程 图 如 图 4. 1 所 示 。 


x) 


| 
wD 


) 
图 4.1 维 纳 滤波 的 输入 /输出 关系 


其 中 , z(z) 为 有 用 随机 信号 , v(z) 为 随机 干扰 信号 , G(s) 为 实际 滤波 器 传递 函数 ， 
WC) 为 理想 的 滤波 器 传递 函数 , 20 为 Gs) 的 实际 输出 信号 ,za(D) NWO) 的 预 
期 输出 信号 。 则 

WCG) =1 滤波 问题 ; 

W()=e ”预测 问题 ; 

W(s) = s 微分 平滑 问题 。 

这 里 只 考虑 W(s) = 1 的 情况 , 即 滤波 问题 。 

维 纳 滤波 理论 解决 的 是 最 小 均 方 误差 准则 下 的 线性 估计 问题 。 采 用 最 小 均 方 
误差 作为 最 优 滤波 准则 的 原因 在 于 , 它 不 像 贝 叶 斯 估计 和 最 大 似 然 估计 那样 要 求 测 
基 值 所 有 的 概率 描述 ,而 是 只 保留 对 前 两 阶 矩 的 要 求 ,因此 在 这 种 准则 下 的 理论 分 
析 比 较 简单 ,可 能 得 到 解析 的 结果 。 


4.1.2 维 纳 - 霍 夫 方 程 


定义 期 望 输出 与 真实 输出 的 误差 为 e) = z G) 一 (1), 由 于 维 纳 滤波 所 基于 
的 最 优 估计 准则 是 最 小 均 方 误差 准则 , 即 按照 
ELE] = Ellas) 一 40D 了 ) = min (4.1.D 
的 原理 来 设计 滤波 器 的 传递 函数 GC), 或 脉冲 响应 函数 h(t) 。 
BR Wo) = 1 Bf, zat) 一 <(0， 此 时 式 (4.1. 1) 为 
ELED] = Ellr 一 2(0]) = min (4.1.2) 
车 z(t) 和 ws) 为 平稳 遍历 的 随机 过 程 , 则 (e) 和 elz) 也 为 平稳 遍历 的 随机 过 
程 , 则 根据 随机 过 程 理 论 , 式 (4. 1. 2) 可 以 进一步 表示 为 
EEO] = lim ZT |” [OOF de (4.1.3) 


即 均 方 误差 实质 上 是 = = 0 时 的 自 相关 函 数 Re(0) 。 
由 线性 系统 理论 知 , 滤波 输出 为 
2D = f7 hwre CERS 


式 中 , h(z) 为 滤波 器 的 脉冲 响应 , 即 
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AD = L731[G(s)] 

由 式 (4. 1. 4) 可 知 ,为 了 确定 输出 信号 O, 需要 知道 在 (一 co, 十 co ) 中 的 全 部 
信息 , 维 纳 称 之 为 平滑 问题 ,但 是 利用 由 过 去 至 将 来 大 量 的 数据 估计 某 一 时 刻 的 信 
号 ,这 对 于 随机 控制 而 言 意义 不 大 ,因此 维 纳 主 要 研究 式 (4. 1. 4) 当 4 > 0 的 情况 。 
%4 A = 0 Bf, z(t 一 A) = z(t); 4 À = œ Bf, z(t 一 4) = z=(— eo), 可 以 用 z(b 在 
C-eo,t) 区 间 的 数据 估计 当前 时 刻 的 状态 。 由 信和 号 的 历史 数据 推断 当前 信号 的 大 
小 , 维 纳 称 之 为 滤波 。 为 了 方便 理论 研究 ,仍然 采用 式 (4. 1. 4) 的 形式 ,但 是 将 4 的 有 
效 区 间 限 定 在 [0,ce)。 

HRA. 1. 4) 代 人 式 (4. 1. 3) ,得 


1 [r on 2 
ELedO]= imf, [zw-[ aw na] d: 




















Fe 0 Ps O x = 
lim zF taya —2 lim 28 f z(a f? hawza- 


AEEA b: P 
+lim | [rova ou-a] £ 
= Ra (0) —2 [7 AVR DAS hda S ORED 


(4.1.5) 
式 中 ， 


Ra (0) = E [20] = lim & [7 rdt (4.1.6) 
Tree 2T )-r 











R.Q) = E[z()zG—2J= lim p| OGD ALD 


R. Ge—2)= E[z(t—A)z(t—7)] 
= lim z [| 0-va- odt ETS 

Ra (0) 为 滤波 器 理想 输出 的 均 方 值 ; R. Q) 为 滤波 器 输入 -理想 输出 互相 关 函 数 ， 
R. (一 z) 为 滤波 器 消息 与 噪声 联合 输入 的 自 相 关 函 数 。 

由 式 (4. 1. 5) 可 知 , 均 方 误差 取决 于 相关 函数 R-(0)、R-(D) Ra G — O) 和 系 
统 的 冲 激 响应 h(z), 即 取 决 于 信号 的 统计 描述 与 系统 的 找 述 。 因 此 ,在 相关 函数 
已 知 的 情况 下 , 均 方 误差 唯一 地 依赖 于 系统 的 冲 激 响 应 。 因 此 , 维 纳 滤波 就 是 寻 
找 一 个 最 佳 的 滤波 器 冲 激 响应 h. C), 使 均 方 误差 Ele] 达到 最 小 。 由 于 
ELA (a) J 是 未 知 函 数 ho C) 的 函数 ,因此 确定 最 优 滤波 器 的 条 件 可 以 用 泛 函 变 分 
的 方法 求 得 。 

依据 式 (4. 1. 5), 为 了 使 E[ e G] 最 小 ,定义 指标 函数 为 


Me WO T£ s, £ 
JRA] TERES | awe Dafa 4.1.9) 


T 








. 82. 最 优 估计 理论 





JAA] 为 滤波 器 脉冲 响应 函数 的 函数 ,因此 是 一 个 定义 在 集合 AA) 上 的 泛 函 。 
下 面 采 用 泛 函 变 分 的 方法 寻求 使 式 (4. 1. DE hA). 
FRAD = qA) e 是 独立 于 4 的 充分 小 参数 , 70) 为 任意 可 微 函 数 ,满足 
10 =04<0 (4.1.10) 
这 个 条 件 对 于 
hA) =0, <0 (4.1.11) 
的 物理 系统 是 必需 的 。 显 然 ,如 果 Ah) 的 变 分 存在 ,那么 必须 满足 式 (4. 1. 11), 28 
则 ,得 到 滤波 器 的 冲 激 响 应 在 物理 上 是 不 可 实现 的 。 
定义 泛 函 
oo oo 2 
J + = lim z£. Ë 20S hD Hewa -aa a: 
(4. 1. 12) 








使 式 (4. 1. 12) 最 小 的 条 件 等 价 为 
SQ] s. lim AA +e] JAD] o 4.1.13) 








计算 差 商 
JRA) HA] Jh] 
€ 


$ T oo 2 
tim zk [| 0- DQ) Hakea} a 


-lim zk [7 [zw f raze vafa 
lm Z [° [o [7 haza pa] noze-va]a 
T ° z 
+ 各 过 [oe oa] dt 
q UAD 0, 得 
r -. š 
血浆 了 [o-i nae pa) noza oara 


=m f [osa —paj'a 
则 当 e — 0 时 ,上 式 右 端 趋 于 0。 考虑 到 Q) 的 任意 性 ,有 
lim zo -J wa ia] [osa a] = 
《4. 1. 14) 
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将 式 (4.1. 14) 展 开 并 交换 积分 与 求 极限 的 次 序 ,得 
[wo im A f ore Dag|as 


-[ eo [oon 2 e 2oze—paJaJar =o 
利用 式 (4. 1. DAAC. 1. 8) ,将 上 式 整 理 后 ,得 
[E MORiS" [S ADR NA]dr=0 (4.1.15) 


由 前 述 可 知 , 当 一 co 过 r+ 二 0 时 , nG) = 0, 无 论 中 括号 中 的 值 是 多 少 , 等 式 都 成 
立 ; 当 0 委 r 志 co 时 ,由 Mr) 的 任意 性 可 知 ,必须 有 


[六 zapRecc-Da]-R<co=or>o (4.1.16) 


因此 ,使 均 方 误差 最 小 的 系统 冲 激 响 应 h(z) 必须 满足 式 (4. 1. 16) ,或 者 说 ,最 佳 滤波 
器 的 单位 冲 激 响应 hop.(z) 应 该 是 式 (4. 1. 16) 的 解 。 式 (4. 1. 16) 就 是 一 个 典型 的 维 
纳 - 霍 夫 方 程 。 

由 推导 过 程 可 知 , 式 (4. 1. 16) 只 是 取得 极 值 的 必要 条 件 , 而 不 是 充分 条 件 。 但 
是 ,从 均 方 误差 的 定义 可 知 , 当 zx(z) 与 (7) 的 差 值 增 大 时 , 均 方 误差 也 在 增 大 。 因 
此 ,可 以 判断 ,如 果 式 (4. 1. 16) 的 解 存在 ,一 定 是 满足 最 小 均 方 误差 的 , 维 纳 - 霍 夫 方 
程 的 解 一 定 是 最 佳 滤波 器 的 冲 激 响 应 , 记 为 hon (t). 这 时 , 维 纳 - 霍 夫 方程 可 以 写 为 

RD = [7 ha QR. DQ, r> 0 (A. 1.17) 

即 虽然 变量 = 存在 于 (一 cc,cc), 但 是 维 纳 - 霍 夫 方 程 仅 在 [0,co) 上 有 定义 。 

这 是 由 美国 学 者 维 纳 教 授 于 1949 年 发 表 的 研究 成 果 , 与 此 同时 ,前 苏联 学 者 柯 
尔 莫 哥 洛 夫 (A. H. Komworo6pos) 也 证 明了 上 述 结 论 。 

将 式 (4. 1. 17) 求 出 的 滤波 器 脉冲 响应 函数 hon G) 代入 式 (4. 1. 5), 可 得 维 纳 滤 
波 器 的 最 小 均 方 误差 为 


EEO] =R) |7 [S7 AOAR Dda] >00 








即 EEO] = Ra (0 | [AOAR ddd G. 119 


4.1.3 维 纳 滤波 器 的 物理 意义 

为 了 进一步 讨论 维 纳 - 霍 夫 方 程 ,在 此 简单 回顾 一 下 输入 -输出 互相 关 定理 。 这 
个 定理 描述 了 线性 系统 中 输入 -输出 互相 关 函 数 .输入 自 相关 函数 及 系统 冲 激 响应 之 
间 的 关系 。 

车 线性 系统 的 随机 输入 为 z0), 有 用 信号 为 z(z) , 输出 为 斌 (z) , 则 系统 的 输入 - 
输出 互相 关 函 数 可 以 定义 为 
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R.C = lim za | =()2G + Oa: (4.1.19) 
已 知 线性 系统 的 输入 输出 及 冲 激 响应 之 间 的 关系 为 
2D = [7 Awa 


将 其 代入 式 (4. 1. 19) ,得 s z 
Ra (= lim zh f yd hat 
ta 2T J- — 
sa 让 (4. 1. 20) 
= had lim zz f Orate dd 


式 (4. 1. 20) 第 二 个 等 式 中 


Ima |" =Dzc+r-Dd=RGc 一 N) (4.1.21) 
因此 有 
Ran = Ü AOR- aD (4.1.22) 
RU. 1. 22) 即 输入 -输出 互相 关 定 理 , 它 表明 :线性 系统 的 输入 -输出 互相 关 函 数 是 系 
统 冲 激 响 应 和 输入 自 相关 函数 的 卷 积 。 
输入 -输出 互相 关 定 理 的 频率 域 形式 为 
Ra (o) = H(w) Ma (a) (4.1.23) 


R, Ra 0) = |7 Ra DEd Ho = [T KO de Raa) = 人 Read 


RC. 1. 23) 表 明 : 线 性 系统 的 输入 -输出 互 功率 谱 密度 是 系统 传递 函数 与 输入 功 
率 谱 密度 的 乘积 。 

在 上 述 研 究 的 基础 上 ,下 面 讨论 由 维 纳 - 霍 夫 方 程 寻求 的 最 佳 滤波 器 的 物理 实现 
问题 。 这 不 仅 为 了 认识 维 纳 -和 霍 夫 方 程 的 一 些 特性 ,而 且 有 助 于 寻找 求解 维 纳 - 霍 夫 
方程 的 方法 。 

比较 式 (4. 1. 17) 和 式 (4. 1. 22) ,可 以 发 现 二 者 是 相似 的 ,不 同 之 处 在 于 : 

Q 式 (4.1.17) 的 左 端 是 输入 -期 望 输出 的 互相 关 函 数 ; 

@ 式 (4.1.17) 中 包含 的 是 最 佳 的 系统 冲 激 响 应 。 

产生 这 种 差别 的 原因 在 于 式 (4. 1. 22) 适 用 于 线性 系统 的 一 般 情 况 ,而 式 (4. 1. 17) 
只 适用 于 线性 系统 中 的 最 佳 者 。 下 面 用 输入 -输出 互相 关 定 理 检验 式 (4. 1. 17)。 显 然 ， 
式 (4.1.17) 右 端 是 最 佳 串 激 响 应 与 输入 自 相关 函数 的 卷 积 。 图 4. 2(a) 绘 出 了 这 个 冲 激 
响应 与 输入 自 相关 函数 ,图 4. 2(b) 绘 出 了 二 者 卷 积 的 结果 , 即 最 佳 线性 系统 的 输入 - 输 
出 互相 关 函 数 。 

由 相关 定理 知 

Ra Ohy = Ü han ARa CDA 4.1.24) 


式 中 , [Re O Jp 表示 最 佳 线性 系统 的 输入 -输出 互相 关 函 数 。 
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由 式 (4. 1. IDARA. 1. 22) T ARRERA -ER HERAA, Bl 
Ra (0) = [Ra hy r > 0 (4. 1. 25) 
图 4. OÈ Ra Cr) 的 图 形 。 比 较 图 4 2(b) 和 图 4. 2(c) BT D12381, 4 0 < z— eo Bf, 
[Re (7) Jy M R. (z) 两 函数 相等 ,但 是 当 一 co < < < 0 时 ,二 者 却 不 相等 。 
R(t-A) 
RQ) : h 





o T š 
— +T 


[Re TJom 
四 
R1) 
© 
— z 


ao) 
由 >` ` 
Z 7 
图 4. 2 ” 维 纳 - 霍 夫 方程 图 解 


如 果 式 (4. 1. 25) 中 的 等 式 对 r < 0 也 成 立 (虽然 此 时 系统 在 物理 上 不 可 实现 
的 ) ,但 是 求解 维 纳 - 霍 夫 方 程 的 问题 却 变 得 容易 解决 。 此 时 ,只 需 对 式 (4. 1. 18) 两 侧 
施行 傅 里 叶 变换 ,得 到 














R= (w) = Ho lw) Ra (o) (4. 1. 26) 
RP, Horlo) 是 最 佳 线性 系统 传递 函数 ,可 记 为 


we - 89 


可 见 , 对 于 物理 不 可 实现 的 系统 ,寻求 最 佳 系 统 传递 函数 的 问题 变 得 很 简单 。 
然而 ,一 般 情况 下 ,我 们 并 不 能 精确 知道 系统 的 期 望 输出 ,而 只 要 求 它 满足 均 方 误差 
最 小 。 因 此 , 当 要 求 的 是 一 个 物理 不 可 实现 的 系统 时 ,最 佳 线性 系统 的 输入 -输出 互 
相关 函数 并 不 是 处 处 等 于 输入 -期 望 输出 互相 关 函 数 。 如 果 系 统 是 基于 最 小 均 方 误 
差 设计 的 , 则 系统 冲 激 响应 将 使 式 (4. 1. 25) 中 的 两 个 相关 函数 对 z > 0 相等 ,并 且 允 
许 对 rt 二 0 的 部 分 不 等 (当然 可 以 相等 )。 即 在 区 间 0< r< oo 是 有 限制 的 ,而 在 区 间 
一 2 过 + 二 0 是 无 限制 的 。 如 果 以 g) 表示 输入 -期 望 输出 互相 关 函 数 和 最 佳 线性 
系统 输入 -输出 互相 关 函 数 之 差 , 即 


q) = Ra — | hr WR VA (4.1.28) 


则 由 式 (4. 1.17? 可 知 ,函数 g(r) BI r< 0 可 以 是 非 零 的 ,但 对 + > 0 的 情况 一 定 
是 0, 如 图 4. 2(d) 所 示 , 这 也 是 求解 最 佳 滤波 器 冲 激 响 应 的 关键 。 式 (4, 1. 28) 是 在 





(4.1.27) 
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(—co<r< co) 区 间 存 在 的 , 当 r 之 0 时 ,就 是 维 纳 - 霍 夫 方 程 。 这 样 ,运用 前 述 的 相 
关 定 理 就 可 以 将 积分 方程 转化 为 代数 方程 ,进而 求 得 最 佳 滤波 器 的 传递 函数 。 

下 面 通过 维 纳 - 霍 夫 方 程 研究 最 佳 线性 滤波 器 的 误差 与 输入 -输出 之 间 的 关系 ， 
并 将 这 种 关系 用 几何 的 方法 进行 描述 。 

按 式 (4. 1. 5) 可 以 写 出 最 佳 线性 滤波 器 的 最 小 均 方 误 差 , 即 


Een (t)]= Ra (0) —2 i ha (TIRa (Cr)dr 十 Í hm(Ddr I! — ha QR, (z — AAA 


=R.) — |” ha COR Ddr—| ha Car 


x [Re - 记 和 Ra 一 pu] C4.1.29) 
对 于 + 之 0, 中 括号 项 即 是 维 纳 - 稚 夫 方程 , 它 应 该 等 于 0, 即 
Elea D] = Ra (0) — |7 hon DRs (Ddr (4.1.30) 
可 以 证 明 , 最 佳 线性 滤波 器 的 输入 和 输出 均 与 误差 不 相关 , 即 
E[ew(CDzGd 一 D]= 020 4.1.31) 
Efea (D2(D] = 0, > 0 (4.1.32) 


上 两 式 表明 , e(t) 与 z0) A +G) 都 是 正 交 的 , 即 在 几何 上 eo (t) 垂直 于 z0) 
fi +G) 组 成 的 平面 X, 如 图 4. 3 所 示 。 平 面 X 上 的 点 是 输入 z0) 经 线性 变换 后 可 
能 达到 的 位 置 。 用 一 空间 向 量 表示 期 望 输出 x(9， 对 应 空间 的 A k, SERIE X F 
面 上 选择 一 个 点 A', 使 得 向 量 (7) E z(z)。 显 然 ,应 该 选择 点 A”, 使 çG 是 
Zz(z) 的 投影 。 因 此 ,误差 向 量 也 一 定 是 垂直 于 X 平面 的 。 





图 4. 3 误差 与 输入 -输出 的 几何 关系 示意 图 
4.2 维 纳 - 霍 夫 方 程 求解 
本 节 介 绍 维 纳 - 霍 类 方程 
RW = | hn WR DAA0 
的 两 种 求解 方法 , 即 频 谱 因 式 分 解法 和 伯 德 -香农 法 。 
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4.2.1 频谱 因 式 分 解法 


频谱 因 式 分 解法 是 由 维 纳 和 霍 夫 共同 提出 的 。 下 面 分 四 个 步 又 具体 说 明 这 种 
方法 。 


1. 复 傅 里 叶 变换 
为 了 求解 维 纳 滤波 方程 ,需要 考虑 方程 中 各 函数 的 变换 及 其 在 复 频 域 中 这 些 函 
数 奇异 点 的 分 布 。 
设 有 非 周 期 函数 f(z), 4 £ < 0 BF, f(z) = 0, 并 且 满 足 绝对 可 积 条件 , 即 
[aya < (4.2.D) 
则 它 的 傅 里 叶 变换 为 
Fe) = 去 feide < < (4.2. 2) 
上 述 积分 对 (一 co,co) 区 间 所 有 的 w 值 都 是 收敛 的 。 与 上 式 对 应 的 傅 里 叶 反 变换 为 
AD = 2. Ü Fetiu <o (4.2. 3) 


用 传 里 叶 变 换 直 接 分 析 设 计 系统 时 会 遇 到 一 定 的 困难 ,首先 是 依 里 叶 反 变换 很 难 求 
解 ,其 次 绝对 可 积 的 条 件 使 得 傅 里 叶 变 换 的 适用 范围 受 限 。 为 克服 这 些 困难 , 维 纳 
在 求解 维 纳 - 霍 夫 方程 时 采用 了 复 傅 里 叶 变换 的 方法 。 

传 里 叶 变换 存在 的 充分 条 件 是 函数 f(z) 必须 绝对 可 积 ,可 以 通过 使 不 绝对 可 积 
函数 变 成 绝对 可 积 ,从 而 使 其 傅 里 叶 变换 存在 。 首 先 , 可 以 限制 函数 f(z) 在 正 时 间 
域 ,即使 :二 0 时 , f(z) = 0, 称 这 样 的 函数 为 半 线 消散 函数 ,如 图 4. 4(a) 所 示 。 由 于 
任何 实际 信号 都 有 一 个 起 始 时 间 , 因 此 这 种 限制 是 合理 的 。 其 次 ,将 函数 f(z) 乘 以 
一 个 衰减 因子 e™*〈(o 宇 0, 实数) ,这样 f(z)e™ 就 可 以 满足 绝对 可 积 的 条 件 , 即 


[Pirola <= 
SO 的 傅 里 时 变换 为 


Flow) = [irora 
7 (4.2.4) 
= | poea 


称 Flo,w) 为 f(t)e™ 傅 里 叶 变换 ,或 SO 的 复 传 里 叶 变 换 。 对 应 的 复 傅 里 叶 反 变 
换 为 


fo = È | Fe,oyeeao (4. 2.5) 
设 复 变量 * — ot jw, 则 式 (4. 2. 4) 和 (4. 2. 5) 可 写成 
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FO = [foede (4.2.6) 
fo) 一 [Feds (4.2.7) 
这 便 是 拉 普 拉 斯 (Laplace) 变 换 及 其 反 变换 , 称 f(z) 为 F(s) 的 原 函 数 , F(s) 为 fO 


的 象 函 数 。 

由 于 函数 F(s) #EDCQ8R 20, —co<o< co ( 即 * 平 面 的 右 半 平面 ) 上 必然 收敛 ， 
所 以 在 此 区 域内 没有 极点 ,因此 F(s) 所 有 的 极点 都 分 布 在 s 平面 的 左 半 平面 上 ,如 
4.4(b) 所 示 。 

以 上 研究 的 是 左 半 线 消散 函数 f(z) 的 复 傅 里 叶 变换 情况 。 可 以 用 类 似 的 方法 
研究 右 半 线 消散 函数 gG) (如 图 4. 4(c) 所 示 ) 的 复 傅 里 叶 变换 情况 。 这 时 ,选择 适当 
BJ a < 0, Eg 绝对 可 积 。 经 讨论 可 知 , gCz) 的 极点 分 布 如 图 4. 4(d) 所 示 。 








/0 ED 
o t o| t 
(a) © 
jo jo 
x x 
xD 5 ° 5 
x x 
©) (d) 


图 4.4 半 线 消散 函数 及 其 极点 


2. ar) 的 复 傅 里 叶 变 换 
由 式 (4. 1. 28) 可 知 , 当 由 此 式 决 定 最 佳 滤波 器 的 冲 激 响应 时 , g(r) 必须 满足 


aa) = 0,r>0 (4.2.8) 
则 对 ar) 的 研究 可 以 参照 对 gC) 的 研究 。 设 
| lecperldc<co<o (4.2.9) 


这 说 明 q(r) 的 复 傅 里 时 变换 Q(o,w) ER jo 轴 外 的 左 半 平面 上 没有 极点 。 
对 式 (4. 1. 28) 两 侧 进行 拉 普 拉 斯 变换 ,得 
qe= Í ala, w- hCGOR-Gc 一 0 由 | 
g WR š (4. 2. 10) 
=f R Oerder [ea Ë hr WR 


第 4 章 维 纳 滤波 . 89 + 





式 右 端 第 一 项 为 输入 -期 望 输出 复 功率 谱 密度 , 记 为 
anG = Í Rade (4.2.11) 
式 中 右 端 第 二 项 记 为 
hnl) Ba (s) = |" ed hn WR rN (4. 2. 12) 


这 是 前 边 介绍 过 的 频率 域 互 相关 定理 向 复 频 域 的 推广 。 最 佳 滤波 器 的 传递 函数 和 
输入 复 功率 谱 密度 可 分 别 记 为 


Ha 一 站 iDerd (4. 2. 13) 
Ral) =| Ra Derdr 44.2.14) 
因此 , 式 (4. 2. 10) 最 终 可 以 写成 
i QG) = Ra (s) — Hop Gs) Re (s) (4.2.15) 
下 面 讨论 如 何 用 频谱 因 式 分 解法 求解 这 个 方程 。 


3. 频谱 因 式 分 解法 
首先 讨论 输入 功率 谱 密 度 函 数 Ra ls) 的 零 极点 分 布 情况 。 假 定 p= (s) 为 有 理 
数 , 即 


RGG) 
P(s) 


RP, RG) 与 PG) 是 多 项 式 。 因此 ,上 式 又 可 以 写 为 
Üe- -rt 
R=(s) = A? H A: -1 
Ie- I[G—p)G+ p) 
式 中 , Ari A p: 均 为 正 实 常数 。 多 = (s) 的 零点 和 极点 均 在 c 轴 上 ,并 且 成 对 出 现 。 
若 零 极点 不 在 实 轴 上 , 则 式 (4. 2. 16) 又 可 以 写 为 


Ht- Cra + jb) JCs — Cra — jb) ] 
Rals)= A? + 


HE= (p: ja) Es — (pi —jai)] (4. 2.17) 
[s— Cr, +jb.)J[s— Cr, —jb,)] 
[一 C bi T ja) ls— C pi —ja)] 
式 中 ,分 子 中 的 小 括号 项 均 为 RCs) 的 根 ,分 母 中 的 小 括号 项 均 为 P(s) 的 根 。a 和 bi 
均 为 正 实数 。 
下 面 将 多 = (s) 表示 成 两 个 因子 乘积 的 形式 , 即 
Ralls) 一 RECS) 89% (s) (4. 2. 18) 


Ralls) = 














(4. 2. 16) 
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其 中 


TEs- Cn +D- Cn —jb)) 

RLG) = A 2 (4.2. 19(a)) 
TICs- C pi +jaj)J[s— C— p, —ja)J 
5 








TICs — G, + jb) JCs — Cri — jbr) ] 
Rls) = A + (4. 2.19(b)) 
T[Ds— C: + jad Es — Cp: — ja:)] 
I 


当 用 式 (4. 2.16) 表 示 多 =(s) 时 ,有 








Testr 
REC) = A (4. 2. 20(a)) 


TL G+) 
k=1 


Ts- 
Ral) = A — (4.2. 20(b)) 
H (s— p) 
由 式 (4. 2. 19) 及 (4. 2. 20) 81, REC) BET 99= (s) 在 左 半 平 面 上 的 全 部 零 极点 ,而 
Ral) 包含 了 Raols) 在 右 半 平面 上 的 全 部 零 极点 ,并 且 REO MRa (s) 是 成 对 出 
现 的 , 即 
RElo) = [Rz (o) J" (4.2. 21(a)) 
Ra (w) = [RE (o) ]° (4.2. 21(b)) 
RA. 2. 18) 可 以 表示 为 
R=(w) = Ri (o) Ra (oo) = | RE Co) |? (4. 2. 22) 
GREC) M Rale) DIERE (s) MRC) 的 拉 普 拉 斯 反 变换 ,由 于 392 Cs) 的 
所 有 极点 均 在 左 半 平 面 上 , 多 =(s) 的 所 有 极点 均 在 右 半 平 面 上 ,所 以 














Rt) = 0,r <0 (4. 2. 23(a)) 
Rz) =0,r>0 (4. 2. 23(b)) 
这 说 明 RE (r) 是 左 半 线 消散 函数 , R= (r) 是 右 半 线 消散 函数 。 
记 
Ie) = TEC) = H TC) = — 
Reals)” 7 REl)” T RCS) 
式 (4. 2. 18) 的 倒数 为 
Pals) = PE GPS Gs) (4.2. 24) 


WRA. 2. 21) 的 倒数 为 
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TE(w) = [TE w] (4. 2, 25) 
Jë yË (z) #ll yç (z) AAA TEC) A Ta) 的 拉 普 拉 斯 反 变换 , 即 
= Ese. 
7: G) = g [roeas (4. 2. 26(a)) 
Pe P 
= 站 [re ds C4. 2.260) 
可 以 证 明 , P'E (s) .P'S (s) YE (z) A yç (z) 都 是 半 线 消散 函数 。 
4. 解 维 纳 - 霍 夫 方程 
由 式 (4. 2. 15) 和 式 (4. 2. 18) 得 
QG) = @=(s) — H,,Gs) RE (s) RZ) (4.2. 27) 


以 多 = (s) 除 式 (4. 2.27)( 相 当 于 乘 以 T=(s) ) 两 端 ,得 
QTES) = #=(s)PS (s) — Hons) RECS) 
在 等 式 两 端 施 以 拉 普 拉 斯 反 变 换 , 得 


[A 


时 (4. 2. 28) 
= fË RaO radd hodRECe— Dd 
下 面 通过 Re(D V2 C — D REC — D RR h, (D, 
令 式 (4. 2. 28) 左 端 积分 为 I 
gD = Ü aoao (4. 2. 29) 
由 式 (4. 2. 8) 81, 4 +> 0 Bf, q(z) = 0; í r> 0 Rf, yal) = 0, 所 以 
g(t) =0,-> 0 (4.2. 30) 
FRU. 2. 28) 右 端 第 二 项 积分 为 
fe) = [as cont G — Dd: (4. 2. 31) 


由 于 hop (E) 是 最 佳 冲 激 响 应 ,所 以 当 上 一 0 时 , 必 有 holt) = 0, X. HT z — 0 B$, 
Rš (z) = 0, 所 以 有 


fŒ) = 0,<0 (4.2. 32) 
令 式 (4. 2. 28) 右 端 第 一 项 积分 为 
go = 六 REG 一 od (4. 2. 33) 


虽然 当 r 二 0 时 ,y=(z) = 0, 但 Re G) 不 是 半 线 消散 函数 ,所 以 y(z) 不 是 半 线 
消散 函数 。 令 


, r> 
z e= | ED (4.2. 34(a)) 


r<0 
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0° rt 二 0 


= 4.2.34(b)) 
v GO r0 t s 
综合 式 (4. 2, 28) 一 式 (4. 2. 34) 得 
gD = D+ DD—fD (4. 2. 35) 


RU. 2. 35) 中 的 四 个 函数 均 为 半 线 消散 函数 。 由 于 在 C— se < + < 0) 上 Fr 和 
gt G) 28 0,# 0 < << c° E g(z) 和 他 (z) 为 0, 则 式 (4. 2. 35) 可 进一步 写 为 
g) = ç` G) (4.2. 36) 
fD= G) (4. 2.37) 
其 中 , 式 (4. 2. 37) 的 结果 是 至 关 重要 的 , 它 将 导出 研究 问题 的 最 终 答案 。 在 式 
(4. 2. 37) 两 端 施行 拉 普 拉 斯 变换 ,再 经 简化 可 得 





H,,G) REC) = [aoar (4.2. 38) 
则 最 佳 滤波 器 的 冲 激 响 应 为 
人 -x 
Hal) = 22 | Ddr (4.2. 39) 
可 证 , Wzr) 还 可 以 表示 为 
= [R=(s) < 
gr) = Cr ita Rali ds (4. 2. 40) 
将 式 (4. 2. 39) 和 式 (4. 2. 40) 相 结合 , 则 得 最 佳 滤波 器 的 传递 函数 为 
Hols) = ga | d “P Ra (Ww) ass do (4.2. 41) 
(s) = 3 RE Jo wim Wz Gu) s 


式 中 , w 为 复 变 量 w = vt ju, 其 中 zx #flo 是 独立 的 实 变量 。 
RCA. 2. 41) 就 是 维 纳 - 霍 夫 方 程 的 复 频 域 解 ,下 面 给 出 其 时 域 解 。 式 (4. 2. 38) 又 
可 以 表示 为 


H.G) = re) Í #' Wedr (4. 2. 42) 
对 式 (4. 2. 42) 两 边 同时 进行 拉 普 拉 斯 反 变 换 , 得 
1 fate _ 1 fatm oo == 
z Haed = h roeas f g (Dexdr (4. 2.43) 
Bp 
haD = |” g Oade (4. 2.44) 


AP, $t (e) 由 式 (4. 2. 34(a)) 确 定 , 而 y£ G — r) 由 式 (4. 2. 26(a)) 确 定 。 
4.2.2 伯 德 -香农 法 


前 面 介 绍 了 频谱 因 式 分 解法 ,求解 原理 虽然 简单 ,但 是 求解 过 程 却 有 些 复杂 。 
这 里 介绍 更 为 简洁 的 一 种 方法 , 称 为 伯 德 -香农 法 。 这 种 方法 是 由 伯 德 (Bode) 
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和 香农 (Shannon) 提 出 的 ,其 核心 思想 是 将 输入 信号 进行 白化 ,因为 白 输入 的 最 佳 滤 
波 问题 比较 简单 ,便于 处 理 。 
l. 白化 滤波 器 
当 线 性 系统 的 输入 z0 = z(D +G) 是 白 输 入 时 , z0) 的 自 相关 函数 是 冲 激 
函数 , 即 
Ra (z) = ó(z) (4. 2.45) 
将 此 结果 代入 维 纳 - 霍 夫 方 程 ,得 


RD =| AnD r> (4. 2. 46) 
由 冲 激 函数 的 性 质 可 知 
Ra (z) = halt) ,rt>0 
再 由 系统 的 可 实现 性 知 
i ha (z) 一 Or 一 0 
综合 以 上 两 式 ,有 
Re(r)， rr 过 0 
= .2.47 
hx (O) Ses (4. 2.47) 


这 就 是 在 白 输入 情况 下 最 佳 线性 滤波 器 的 冲 激 响应 。 
在 一 般 情况 下 ,输入 oG) 是 白 噪声 ,但 输入 的 信和 号 却 不 是 白 的 ,而 是 具有 有 限 带 
宽 形式 的 。 如 果 能 通过 一 个 滤波 器 W(jw) 将 输入 z(z) 白化 , 则 可 以 将 问题 简单 化 。 
这 时 ,滤波 由 两 个 滤波 器 构成 :一 个 是 白化 滤波 器 ,一 个 是 白 输入 滤波 器 ,因此 最 佳 
滤波 器 的 传递 函数 为 
HaGo) = W (jo) H, Go) (4. 2. 48) 
式 中 , WGo) 为 白化 滤波 器 的 传递 函数 ,H.Cjw) 为 最 佳 白 输入 滤波 器 的 传递 函数 ， 
如 图 4. 5(a) 所 示 。 假 设 存在 一 个 可 逆 滤 波 器 ,使 得 
WGW? Go) = 1 (4.2. 49) 
则 
Hon (jw) = Hop GoW? Go) (4. 2. 50) 
这 种 情况 如 图 4. 5(b) 所 示 。 式 (4. 2. 49) 可 以 理解 为 : 若 白化 滤波 器 是 将 输入 白化 ， 
则 其 逆 滤 波 器 的 作用 就 是 还 原 。 
由 上 述 讨论 可 知 ,求解 维 纳 - 霍 夫 方 程 的 关键 是 如 何 建立 一 个 白化 滤波 器 。 在 图 
4.5 中 ,白化 滤波 器 的 输入 为 z(z), 白化 输出 为 yG), 白化 滤波 器 的 传递 函数 为 
Wiw). H Ralo) 表示 输入 z(z) 的 功率 谱 密 度 , 则 W Go) 必然 满足 


R=lw) |WGo)|? = 1 (4. 2. 51) 
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图 4.5 最 佳 线性 滤波 器 


白化 滤波 器 输出 y(z) 的 自 相关 函数 为 
R, (7)= E[y(t)y(t+7r)] 


一 z wiz — uzdu |“ wz +r—u)dv] 
=|? f wowodudvElzu wzat] (4.2.52) 


= Ë [l wowo u— u)dudo 


=), = <r <0 

由 于 输出 y(t) 是 经 过 白化 的 ,所 以 其 自 相关 函数 必然 等 于 8(r)。 式 (4. 5. 52) 中 ， 

wu) R wo) 是 与 WGjw) 相对 应 的 白化 滤波 器 的 冲 激 响应 。 式 (4. 2. 52) 是 式 ` 
(4. 2. 51) 的 时 域 等 价 表达 式 。 由 于 

WOw = | werde 


W jw) = | wn (Weivdr 
式 (4. 2. 49) 的 对 应 时 域 表达 式 为 
[ww — oao = a (4.2. 53) 


AU. 2. 49) ACU. 2. 51)` 式 (4. 2.52) 和 式 (4. 2. 53) 表 明了 白化 滤波 器 的 性 质 。 
首先 应 该 说 明 的 是 ,可 实现 的 白化 滤波 器 W Go) 的 极点 必然 位 于 复 平面 的 左 半 
平面 , 若 逆 滤 波 器 WO Go) 是 可 以 实现 的 ,其 极点 ( 即 WGo) 的 零点 ) 也 应 位 于 复 平 
面 的 左 半 平 面 。 所 以 ,白化 滤波 器 的 极点 和 零点 都 应 位 于 复 平 面 的 左 半 平 面 。 下 面 
通过 一 个 具体 的 例子 来 研究 白化 滤波 器 的 零 极点 分 布 。 例 如 ,一 个 输入 函数 的 功率 


谱 密度 为 的 
Ralu) = A C jo Ta) Qo + a) (4.2. 54) 


C joe+ B) Go + 9) 
可 将 式 (4. 2. 54) 分 解 为 两 个 因子 , 即 
Wa (o) = Rz lw) RE (o) (4. 2. 55) 
其 中 
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= Aloa K: = A—jw+a .2.56 
RElo) A+ S89< (o) 4 二 io 十 8 (4. 2. 56) 


显然 ,22 二 (o) W 89% (o) EIRY, BB 
RE (o) = [8?£ Co) ]” 
由 式 (4. 2. 51) 和 极点 的 分 布 可 知 ,必须 选择 W Go) 使 
R=(w) = |W-1 Go) |? = |R Ço) |? (4. 2. 57) 
成 立 ,才能 使 WGjw) MW Go) 得 以 实现 。 由 此 得 白化 滤波 器 的 传递 函数 为 


1 L ` jeta 
Ww) = aG REO ™ A juta 62:59) 


由 上 述 分 析 可 知 , 依 照 RE (o) 寻求 白化 滤波 器 的 传递 函数 时 ,关键 的 问题 是 能 
否 对 RE Co) 进行 因 式 分 解 ,然后 利用 所 有 位 于 左 半 平 面 的 极点 和 零点 得 到 多 Cw) ， 
进而 得 到 W Qo) , 事实 上 ,每 个 有 理 谱 都 能 进行 如 式 (4. 2. 55) 的 分 解 。 

为 了 研究 一 般 的 情况 ,将 jw 推广 到 复 平面 ,以 :二 o tjo RE jw, 典型 的 零 极 点 
分 布 如 图 4. 6 所 示 。 可 见 , 所 有 分 布 在 左 半 平 面 上 的 零点 和 极点 都 属于 595 Co) , 而 
其 余 的 零点 和 极点 都 属于 多 = Co) 。 














图 4.6 典型 的 零 极点 分 布 图 

HRC. 2. 57) 知 , 多 = (o) 应 该 是 实 的 ,并 且 关 于 o 是 非 负 的 偶 函 数 ,因此 其 零 
极点 的 分 布 具 有 如 下 特征 : 

(1) 关 于 oa 对 称 ,否则 Relu) 将 不 是 实 的 

(2) 关 于 jw 轴 对 称 ,否则 Re Co) 将 不 是 偶 函 数 ; 

(3) 在 j 迎 轴 上 ,任何 零点 都 是 成 对 出 现 的 ,否则 对 某 些 w 来 说 多 = (ao) 将 是 负 的 ， 

(4) 在 jw 轴 上 没有 极点 。 

2. 解 维 纳 - 霍 夫 方 程 

由 以 上 讨论 知 , 可 以 通过 一 个 可 实现 的 可 道 白 化 滤波 器 得 到 一 个 白化 输入 
xG), 然后 求 出 对 yC) 最 佳 的 滤波 器 传递 函数 H”, Go), 而 对 一 般 输入 的 最 佳 滤波 
器 传递 函数 为 

H, Qe) = WOw) H, Go) = zero He je) (4. 2. 59) 


由 式 (4. 2. 59) 可 知 , 求 Ho Go) 等 价 于 求 HS (jw)。 
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类 似 于 式 (4. 2. 47) ,有 
roa [R0 tr>0 
hato Í 0， <0 
R H, Go) 等 价 于 求 holt), HAC. 2. 60) 知 , 求 Aspel) 必须 求 Re Co) ,而 
R, (7)= E[yG —r)=(t)] 


= REO [wz — s vdo] 


(4. 2. 60) 


°. 4.2. 61) 
= [Í ww ELz(t)z(t—r— v)]dv É 
= 人 woRec+odn 
S o =—B, RA. 2. 61) 化 为 
Ra =| WDR- CDd (4.2. 62) 
应 用 输入 -输出 互相 关 定理 , 式 (4. 2. 62) 的 频 域 表达 式 为 
Ma (o) = W" Go) Ra (w) = CA (4. 2. 63) 


再 将 式 (4. 2. 63) 进 行 反 变换 就 可 以 获得 Ra (=), 只 是 要 注意 ,需要 的 只 是 + 之 0 的 部 分 。 
H [Ra lw) le RR Rale) 对 r 宇 0 的 变换 ,得 


[gx C01,= | R. (eid 
i (4. 2. 64) 
= | heivdr 
同 理 得 
[Ra (1 = Rs Veinrdr (4. 2. 65) 
显然 有 
Ry (a) = [Ro (o) + [89,, Go) ]- 
这 样 ,利用 式 (4. 2. 63) 就 可 以 得 到 
Ha GW) = [gx (j= [W Go) Ra G), = [gs ] 2.669 


综合 式 (4. 2. 59) 和 式 (4. 2. 66) ,得 最 佳 滤波 器 的 传递 函数 为 


,、__1 [多 = 人 w) 
Haw) = goes [2262 ], (42.60) 


可 以 看 出 , 伯 德 -香农 法 求解 维 纳 - 霍 夫 方 程 的 思想 是 ,假设 一 个 能 将 非 白 输入 转 


换 为 白 输 入 的 白化 滤波 器 ,用 白化 滤波 器 作为 过 渡 , 将 求解 维 纳 - 堆 夫 方程 简化 。 求 
解 过 程 可 概括 为 以 下 几 个 步 又， 
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(1) 分 解 输入 功率 谱 密度 为 殉 #(o) WMR (o) 两 部 分 。 其 中 ,28 去 (w) 的 零 极点 
全 部 位 于 复 平 面 的 左 半 部 分 , = (o) 的 零 极 点 全 部 位 于 复 平面 的 右 半 部 分 , 且 
Sp: (o) M Rl) EAIN. 

(2) 将 yG) 与 (0) 的 互相 关 功 率 谱 密 度 表示 为 
R= (o) 
Rzlw) 
上 式 建立 了 z(t)、y(t) 和 z(t) 三 者 之 间 的 关系 。 

(3) 实现 对 z(z) 的 最 佳 滤波 器 ,其 冲 激 响应 为 
R。(r)，r 过 0 

0, r< 

考虑 实现 时 ,将 求解 ise(r) 的 问题 转化 为 求解 Re (r) 的 问题 , Rs Co) 对 r 之 0 的 变 
换 为 


Rx (w) = 





hale) = 


Hon Gw) = [Ra Go) 1, 
其 中 ， 
R= (o) 
[gx (l= Faa ] + 
(4) 最 后 得 非 白化 输入 z0) 的 最 佳 滤波 器 传递 函数 为 
Ho jw) = W (je) HV, Geo) 


=a [SO], 


4.3 线性 连续 系统 维 纳 滤波 应 用 举例 


4. 2 节 研究 了 维 纳 - 霍 夫 方 程 的 两 种 解法 :频谱 因 式 分 解法 和 伯 德 -香农 法 ,分 别 
由 式 (4. 2. 41) 和 式 (4. 2. 67) 给 出 了 滤波 器 最 佳 传递 函数 的 一 般 解 。 实 际 上 ,这 两 种 
解法 适用 于 一 类 广泛 问题 的 研究 , 即 可 以 将 4. 2 节 中 关于 滤波 问题 的 研究 结果 推广 
到 预测 和 平滑 问题 。 

设 滤 波 器 输入 信号 为 20), 含有 用 信息 为 0), 噪声 为 va), 即 

z(t) = z(t) + (0) (4.3.1) 
其 中 , z0) z(t) 和 oG) 均 为 平稳 过 程 。 滤 波 的 期 望 输出 可 以 是 有 用 信息 zG) ,也 
可 以 是 其 延 时 或 导 前 , 即 滤波 ,平滑 和 预测 问题 。 若 延 时 或 导 前 的 时 间 为 a 秒 , 则 滤 
波 器 的 期 望 输出 为 

zalt) = zGt+a) (4. 3. 2) 


由 于 最 佳 传递 函数 是 通过 Ra (o) 和 多 =, Go) 表示 的 ,所 以 首先 求 出 它们 的 值 。 
为 此 , 先 需 要 求 出 它们 对 应 的 输入 自 相关 函数 R-(r) H Ra (7)。 
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Re 7)= ELz(t)z(t+7)] 
= E([zG) +u) [zG+ z) Hot] 
= E[z(Oz@G +o] HEAO ot +) ] + E z(OuG +) ]+ E[o(DzG + r) J 
= R,, ©) HRe (z) +R,,(?) +R, (2) (4. 3.3) 
与 Re=(r) 对 应 的 功率 谱 密度 为 


有 8-(wW 一 | RDeierde 


= # (o) Ruw Co) + 89, (o) HRe Qo) 
如 果 信号 与 噪声 不 相关 , 则 上 两 式 还 可 以 简化 , 即 两 式 中 的 后 两 项 可 以 去 掉 。 
输入 -期 望 输出 的 相关 函数 为 
Ras (e) = E[zG)zG-+r+a)] = Rault Ea) (4. 3, 5) 
#= (z +a) 还 可 以 进一步 表示 为 
#, (ea) = Rala) +. (z Ea) 


(4.3. 4) 


它 所 对 应 的 功率 密度 谱 为 
Ra, Q= | R.G oye ist dr Q 
= e= R (w) 
式 中 Ru (o) = Ra (a) Ra (o) 
式 (4. 3. 6) 中 em 本 身 则 包含 有 延 时 或 导 前 的 意义 。 
由 式 (4. 2. 1) 和 式 (4. 2. 2) 可 得 
Ha) = zz | r+ edr (4.3.7) 
RP, 8p= (s) 可 由 式 (4. 3. DWE, Wr 士 c) 为 
Wrta 一直 Balo esta (4.3.8) 
下 面 通 过 两 个 例子 研究 滤波 问题 比较 具体 的 情形 。 
例 4.1 设 信号 的 功率 谱 密 度 为 
Rala) = r= (4.3.9) 
噪声 为 白 噪声 ,功率 谱 密度 为 
Rela) = PË (4. 3. 10) 
信和 号 与 噪声 互相 关 函 数 为 零 
89. (o) = Ralo) = 0 (4.3.11) 


采用 频谱 因 式 分 解法 求 维 纳 滤波 器 的 传递 函数 。 
首先 ,将 Ral) 作 如 下 分 解 
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Je+ tp i aa 

Raks) (4. 3. 12) 
IFA 

记 为 ROD CREDOR (4.3.13) 

















其 中 RELS) 一 一 (4. 3. 14(a)) 


P +% m [Zes 
kasuspas: r sasakii (4.3.14(b)) 


由 假设 多 = (o) = 0, 所 以 有 
8@. (s) = Raols) 一 += 
将 式 (4. 3. 14b) 和 式 (4. 3. IDARA. 3. 


$ ) ra: B p >, 


ie 
多 z 士 o) 一 pe a 
= etto ds 


A tjo 
2mj = atw ey N.) 


多 = (s) = 


(4.3.15) 











1 


ni 
Ip pr e 


(4. 3.16) 








式 中 ¿ye 可 以 分 别 表示 为 


te cw/p， >= 
= etto dr = É sa (4.3.17) 
0, r<Fa 








2rj ao Ir 





es 1 
Sd 1 i zta) 
珂 Jo sts ma [P N. y 


(4.3.18) 
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2 i + 学 
(J +h + b) d p 


则 式 (4. 3. 16) 可 表示 为 

















ŞA 


Ach, t >Fa 
Kra) =l an =: (4.3.19) 


这 样 就 得 到 了 式 (4. 3. 8) 的 一 个 实际 解 。 
下 面 依据 式 (4. 3.7) 和 式 (4. 3. 19) 求 H; (s), 


由 式 (4. 3. 14(a)) 知 
Jet% +o S /ty 
(4.3. 20) 


1+ ps -> Ë +s 








REC) = 
则 最 佳 延 时 滤波 器 的 传递 函数 为 
H;,(s)= = zoh Wir 一 a)e<dr 
- z O zoll eerde t|? hemde] 


ki +s AL Cki +k)e™ — (h +s)e*e] (4. 3. 21) 
(k: kı — 
Tonto 1 +s) (kz — s) 














k — ki) kDa — h L De 
例 4. 1 采用 了 频谱 因 式 分 解法 ,下 面 再 举 一 个 应 用 伯 德 -香农 法 的 例子 。 
例 4.2 设 滤波 器 输入 为 


z() = z() 十 Ci) (4. 3. 22) 
式 中 , z(t) 和 oG) 为 互 不 相关 的 平稳 随机 过 程 , 其 对 应 的 功率 谱 密度 为 
Ralo) 一 — 2 (4. 3. 23) 
Ralu) = PË (4. 3. 24) 
滤波 器 的 期 望 输出 为 zalt) = z(t ó (4. 3. 25) 


应 用 伯 德 -香农 法 求 最 佳 白 输 入 滤波 器 的 冲 激 响应 ho Ce) 。 
首先 求 输入 的 自 相关 函数 对 应 的 功率 谱 密度 ,并 对 其 实现 进行 因 式 分 解 。 由 于 
LCE) 和 w(t) 是 互 不 相关 的 ,由 式 (4. 3. 4) 和 式 (4. 3. 22) 一 (4. 3. 24) ,得 


= = k N 
Rew)= Ralo) Rulu) = z pta 
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Doat +) + 2k 
— ELE T 
4 
_ Mth (1+aN;) 
= a +Ë 
+ J = Ac: WRU. 3. 26) 可 写 为 
R 


=N e +EGQ+J 
Rala) = 7 JFE 
No joe+ k /1+ J —jw+k /1+ J (4.3.27) 
2 jo +Ë 一 jw 十 
= Ri (o) Ra lw) 


(4. 3. 26, 








式 中 
aiw) = N iet AEI (4. 3. 28(a)) 
jo + Ë 
— k i s (4. 3. 28(b)) 
以 下 求 输入 -期 望 输出 互相 关 功 率 谱 密度 Re (w) 。 首先 求 输入 -期 望 输出 互相 
AKM 
Ra, (0) = ELra(Dz(t 一 D] 
= E{za(D[z(t—D +uG—OJ) (4. 3. 29) 
= Elna (Dra — )]+ E[z.(DsG —O)J 
由 于 za = zG +a), 并 且 由 于 信和 号 与 噪声 是 不 相关 的 ,因此 式 (4. 3. 29) 中 的 第 二 项 
为 0, 于 是 式 (4. 3. 29) 可 写 为 
Ra, (©) = ELza(t 士 Dz(t 一 上 ] = Ra lr Ea) (4. 3. 30) 
对 式 (4. 3. 29) 实 行 傅 里 叶 变换 ,得 
Ra, (w) = Re (w) = =. 


获得 Rara Co) 后 , 便 可 以 进一步 求 白 输入 期 望 输出 互相 关 功 率 谱 密度 
Bz (w) _ 2ket= 一 jw 十 k 


Ri) w+ 
SSS Noc ju+k IFD) 


(4. 3. 31) 








Rp, (w) 


4. 3. 32 
2ko Š ; 


Nt -ith VIFT 
依据 维 纳 - 辛 钦定 理 , 白 输入 -期 望 输出 的 互相 关 函 数 为 
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Ra O= E [T Ra wedo 
T 2ket= 
=s. i [qo DC ie+k VT |= 
为 方便 求解 ,将 上 述 傅 里 叶 反 变换 转换 为 拉 普 拉 斯 反 变换 , 即 
Re (nD = s ike Roa (s)e" ds (4. 3. 34) 
积分 是 沿 虚 轴 的 ,积分 环 路 如 图 4. 7 所 示 。 


由 双向 拉 普 拉 斯 变换 知 , 当 沿 逆 时 针 环 路 积 
分 时 ,得 rz>> 0 的 时 间 函 数 ; 沿 顺 时 针 环 路 积分 时 ， 
得 到 + 一 0 的 时 间 函 数 , 即 


Ra, (7) = = is (s)e=ds,r > 0 š 
fa 
(4. 3. 35) 


Ra = S Rm (Gs)e"ds,r < 0 
be 
(4. 3. 36) 图 4.7 双向 拉 普 拉 斯 变换 示意 图 


(4. 3. 33) 





求解 以 上 两 个 环 路 积分 ,得 


2 1 kleta) 
N IT Z° ， rtŁa>0 
Ry,(7) 一 2 1 (4. 3. 37) 
VIFT Ceia) 
N II = l ， rka<0 
由 式 (4. 2. 47) 可 得 对 白 输入 y(z) 的 滤波 器 最 佳 冲 激 响应 为 
hç Ce) = Ra, G) (4.3. 38) 


4.4 线性 离散 系统 维 纳 滤波 


前 面 都 是 针对 连续 时 间 系 统 讨论 维 纳 滤波 的 原理 和 应 用 。 随 着 数字 计算 机 的 
发 展 和 应 用 的 普及 ,离散 时 间 系统 的 维 纳 滤波 也 越 来 越 受到 人 们 的 关注 。 

设 有 一 个 不 可 直接 测量 的 随机 信号 zx 混合 在 噪声 v 中 ,可 以 直接 测量 的 信号 
z 满足 








z = z + (4. 4. 1) 
式 中 , ww 可 以 是 白 噪声 序列 ,也 可 以 是 有 色 噪 声 序列 , z, 和 w 都 是 广义 平稳 的 遍历 
随机 序列 。 


第 4 章 维 纳 滤波 * 103 + 





希望 找到 一 个 离散 时 间 滤 波 器 ,以 得 到 z, 的 最 优 估 计 。 定 义 估计 误差 为 


Zr = z —š (4.4.2) 
则 这 里 的 最 优 是 使 均 方 误差 最 小 , 即 
E[#1]] = E[ Gy — 2,22] = min (4. 4.3) 


维 纳 滤波 器 的 信息 流程 图 如 图 4. 8 所 示 。 


图 4. 8 维 纳 滤波 器 信息 流程 图 


这 里 只 研究 滤波 器 是 因果 的 情况 。 假 设 以 hh 表示 离散 时 间 因果 线性 时 不 变 滤 
波 器 的 冲 激 响应 , 则 z, 的 估计 £, 可 表示 为 


和 = D hize (4.4.4) 
名 


假设 >, 和 >* 是 零 均值 的 ,求解 式 (4. 4. 4) 所 示 的 因果 线性 时 不 变 滤波 器 。 根 据 
正 交 性 原理 ,估计 误差 与 观测 数据 是 正 交 的 ,于 是 有 








Ella — êz] 一 0 0 入 j<<co (4. 4. 5) 
HRA. 4. 4) 代 入 式 (4. 4. 5) 并 取 数 学 期 望 , 则 得 关于 h, 的 方程 
R. = DhRe i =o 0<;j<>o° (4.4.6) 
假设 z, 和 zk 是 广义 联合 平稳 的 随机 序列 ， WRA. 4. 6) 可 表示 为 
A; a=- XR. G&—i—j)=0, 0Kj<% (4.4.7) 
* k— j= m, WRU. 4. 7) 化 为 
Rs (m) XR cm ü) =0, m=0,1, (4. 4.8) 


事实 上 , 式 (4. 4. 8) 就 是 前 面 讨论 过 的 连续 时 间 维 纳 - 堆 夫 积分 方程 的 离散 形式 。 
相应 地 , 式 (4. 4. 8) 的 解 就 是 离散 时 间 最 优 因 果 线 性 时 不 变 滤波 器 的 冲 激 响应 函数 。 
求解 过 程 与 连续 时 间 系 统 的 情况 相同 ,只 是 将 拉 普 拉 斯 变换 替换 为 = 变换 。 

定义 序列 


fG) = R.G)— D hR G — i) (4.4. 9) 
= 
对 式 (4. 4. 9) 两 边 实施 = 变换 ,得 
F(z) = #,, G) — H(z) Ra (2) (4. 4.10) 


RE, 多 = G) l Rale) 分 别 是 Re G) A R. G) 的 = 变换 (由 于 hO) 是 因果 的 , 因 
此 单 边 = 变换 和 双边 = 变换 等 价 ,在 此 不 区 分 ) 。 
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由 式 (4.4.9) 可 知 , 当 j 宇 0 时 , fG) = 0, 但 是 当 j <0 B, fG) 可 能 是 非 零 的 。 

为 了 方便 求解 ,将 用 = (z) 分 解 如 下 
Ral) = RE (2) R=(z) (4.4.11) 

其 中 , RE) BAT Ral) 的 零 极 点 在 单位 圆 内 的 部 分 ,而 89% (z) UET Rale) 
的 零 极点 在 单位 圆 外 的 部 分 。 

与 连续 的 情况 相同 的 是 ,这 里 的 分 解 过 程 也 称 为 谱 分 解 。 在 式 (4. 4. 10) 的 两 侧 
BRA Rale), 得 
Raz) 











Flz) —_ 
Ao TT HO @t G) + ges) (4. 4.12) 

在 式 (4. 4. 12) 两 侧 施 行 双边 逆 = 变换 ,得 
g [mao RED] Hz Ee] C4. 4. 13) 


其 中 , xp? 表示 双边 逆 -变换 。 

由 于 O) 在 正 时 间 轴 上 取 值 为 0, 那 么 F(z) 的 极点 应 该 位 于 单位 圆 外 。 由 于 
Rale) 所 有 的 零点 都 在 单位 圆 外 ,而 Ra (z) 在 式 (4. 4. 13) 的 分 母 上 ,因此 它 产生 的 所 
有 极点 都 位 于 单位 圆 外 。 可 见 , 式 (4. 4. 13) 左 侧 的 逆 变 换 在 正 时 间 轴 上 等 于 0。 此 外 ， 
H(z) 是 因果 稳定 的 , 它 的 极点 只 能 位 于 单位 圆 内 。 根 据 定 义 , Ri) 只 在 单位 圆 内 
有 极点 ,所 以 式 (4. 4. 13) 右 侧 第 一 项 是 正 时 间 轴 上 的 信号 。 于 是 , 式 (4. 4. 13) 的 单 
边 = 变换 表示 为 

H(z) RE (z) = x, [z [E] (4.4.14) 


Raz) 
式 中 , z, 表示 单 边 z- 变 换 。 
这 样 ,在 零 均值 联合 广义 平稳 过 程 条 件 下 ,离散 时 间 最 优 因果 线性 时 不 变 滤 波 
器 的 传递 函数 为 





[B= (z) 
= |= io] (4. 4.15) 
BE Za 


参考 连续 时 间 系 统 的 情况 ,如 果 多 =(z) #l Rele) 是 = 的 有 理 函 数 , 则 滤波 器 的 传递 
函数 可 简化 为 





H(z) = 





£=] 
+ 


s [e= 
H) = RE(z) 


以 下 举例 说 明 离散 时 间 系 统 维 纳 滤波 器 的 求解 。 
例 4.3 设 观 测 过 程 z(z) 是 信号 z(t) 和 噪声 过 程 nt) 之 和 , zG) 是 z0) 在 
t= nT 时 刻 的 采样 。 希 望 从 =(z) 中 估计 出 z(n), 这 里 =(z) È r) £ t= nT 时 刻 


HRPE, 20 和 xz) 的 自 相 关 画 数 分 别 为 Re (c) = ei! 和 Rn 一 二 el" 。 


C4. 4. 16) 
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假设 z(z) fl nG) 是 相互 正 交 的 。 令 采样 间隔 工 一 0. 69314718s。 求 解 最 小 均 方 意义 
上 可 实现 (因果 ) 的 维 纳 最 优 滤波 器 的 传递 函数 H(z)。 

解 本 题 的 谱 是 有 理 分 式 , 即 满足 式 (4 4. 16) 的 条 件 。 首 先 求解 各 自 的 自 相关 
函数 和 互相 关 函 数 ,然后 进行 = 变换 。 

Ra G) = ELzG +k)<G)] = E{zG + )[z=G) +nG)J) = Ra G) 
上 式 最 后 一 步 利 用 了 z(z) P nG) 是 正 交 的 特性 , 即 对 任意 7 A k H ELzGOnG)] = o, 
观测 过 程 的 自 相关 函数 表示 为 
R. G&)= E([z=G +k) +nG +) J[zG) +nG)]) 
= R. G) +R, (k) 
互相 关 函 数 和 自 相关 函数 的 z- 变 换 分 别 表示 为 


@=()= [Ra W] = Re KT] = e| Eei ] 











=4[ z z ] =0,75z 
2Lz 一 ET r~e. (z—0.5)(z— 2) 


1 E E 1 i EPONE 
Wæ (x) 让 =] + 4 — z ==] 
一 0.75z 0. 9375z 
(#—0.5)Xe—2) (z—0.25)(z—4) 


= — 1. 6875z(z — 0. 34044) (z — 2. 93733) 
(z 一 0.5)(z 一 2)(< 一 0.25)(z 一 4) 


一 0.787143(z 一 0. 34044)z 。0. 787143(z-: — 0. 34044)z: 
(z 一 0.25)(z 一 0.5) 《一 .25 一 一 5) 


于 是 , 多 = (z) 的 谱 分 解 表示 为 
0. 787143(z— 0. 34044)z 


























0. 787143(= 1 — 0. 34044)z! 

















G) = LC 0 te—0.5) ' =G) = i025 I — 0.5) 
因此 有 

af ff  —0.75z _ (Z! —D0.25)(21—0.5) 

z 5] [Gh 340405 ] 


A [— 0. 34984z(z— 4) 
ki = 5)(z—2. 937535 ] 
其 中 ,大 括号 里 的 分 式 可 以 分 解 为 事件 大 于 0 的 部 分 和 实践 小 于 0 的 部 分 , 即 


0. 34984z(z — 4) Az + Bz 
(z—0. 5)(z— 2. 93733) z—0.5 ' z— 2.93733 














这 样 








= |= [a SC z ssrss ]| afr trm )] 


Az 
要 一 本 
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其 中 


_ 0. 34984z(z—4) e 
A | 三 080237 


根据 式 (4. 4. 16) ,因果 离散 时 不 变 滤波 器 的 传递 函数 为 


0. 50237 0. 637812 — 0. 25) 
HO = AEO e05) 2—0.310445 


对 H(z) 进行 逆 = 变换 ,得 滤波 器 的 离散 时 间 单 位 冲 激 响 应 为 
h(n) = 0. 4683678(m) +0. 169445 (0. 340445)"u (n) 

响应 的 连续 时 间 单 位 冲 激 响应 ho (z) 表示 为 

ho (z) = 0. 5811398(n) +0. 243416e 1 581139, (z) 
如 果 对 ho(z) 在 t = nT = 0. 69314718n 时 刻 采样 ,得 到 

ho (nT)= 0. 5811398(m) + 0. 24341667 S83883n(0. 69314718) 1, ( y) 
= 0. 5811398(m) + 0. 243416(0. 334218)"u (m) 

可 见 , h(n) 并 不 是 连续 时 间 ho Ga) ZE t = nT 的 采样 。 





思考 题 


41 设 由 平稳 测量 序列 z = zi 十 ei,i==1,2,…,n。 已 知 E[z?] = S,E[e]=0,E[e]=0， 
EL[xiei] = 0,E[eei] = 0。 设计 一 个 维 纳 滤波 器 ,并 求 对 z, 的 估计 。 


4-2 假设 信号 2O 具有 有 理 功率 谱 于 = o) = l ， 白 噪声 的 功率 谱 为 52。 Cu) 一 地， 信 
号 与 噪声 不 相关 , 求 维 纳 滤波 的 冲 激 响 应 h (O), 

43 假设 信号 =( 的 功率 谱 为 Ra (S) = La, 响声 的 功率 谱 为 Ra (O 一 了 5， 信号 
与 噪声 不 相关 , 求 维 纳 滤波 器 的 传递 函数 。 

4-4 设 一 个 平稳 高 斯 信号 的 谱 密度 函数 如 下 


~ +1 
Ralo) = rt 16 


求 当 a = 1 时 的 最 优 预 测 器 。 
4-5 一 个 平稳 维 纳 预测 器 中 信号 和 噪声 的 自 相关 函数 分 别 如 下 : 
Re (rn = 4e! 
Re (o) = et 
信号 和 噪声 互 不 相关 ,预测 时 间 0. 25s。 求 最 优 传递 函数 。 
46 系统 如 下 图 所 示 


~ =; 


其 中 xD 一 9 十 KD,z(b 为 平稳 随机 信号 ,功率 谱 密 度 Ra C) 及 相关 函数 Ro (r) 均 为 已 知 ， 
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MO 为 平稳 干 护 过 程 ,其 功率 谱 密 度 Pa CO RARER R. CO 互 不 相关 。 其 中 ， Ralo) = 
EB A> 0,B > 0, 均 为 常数 ; vn) SEREH Rulu) = 于。 计算 维 纳 最 优 滤波 器 的 均 


a + 
方 误差。 
4-7 已 知 测量 方程 如 下 
z(t) = ao + (t) 
其 中 , ao 是 均值 为 0 且 方 差 为 2 的 未 知 随机 常量 。 附 加 噪声 为 白 噪 声 ,功率 谱 幅度 为 A。 求 ao 的 
最 优 估计 。( 初 始 时 刻 t = 0s ) 


4-8 已 知 平稳 随机 序列 {z(2) ,k = …, 一 1,0,1) 的 功率 谱 密 度 函 数 为 
= LA 
89. (z) = a-pe = 20 <la4l<1 
干扰 序列 (n0), k = --,—1,0,1) 为 白 噪 声 序列 ,其 功率 谱 密度 为 80. (z) = = , 两 个 随机 序列 互 


不 相关 , 求 维 纳 最 优 滤波 器 的 传递 函数 。 


第 5 章 随机 动态 系统 数学 模型 


内 容 提要 首先 给 出 确定 性 动态 系统 的 数学 模型 ;其 次 在 考虑 干扰 和 骂 声 的 情 
况 下 得 到 随机 动态 系统 的 数学 模型 ;之 后 介绍 模型 转化 问题 ,包括 连续 模型 与 离散 
模型 的 相互 转化 方法 ,以 及 非 线 性 模型 的 线性 化 方法 ;最 后 讨论 模型 建立 过 程 中 需 
要 注意 的 一 些 实际 问题 。 


5.1 确定 性 动态 系统 模型 


后 面 章节 的 内 容 时 刻 围绕 随机 动态 系统 模型 展开 ,或 者 说 ,研究 对 象 是 带 有 随 
机 性 质 的 。 随 机 动态 系统 模型 其 实 是 确定 性 动态 系统 模型 附加 一 个 随机 干扰 构成 
的 。 首 先 介绍 确定 性 的 动态 系统 模型 。 

对 实际 的 动态 系统 建 模 时 ,模型 的 形式 由 具体 的 使 用 要 求 决 定 。 因 此 ,动态 系 
统 的 模型 表现 为 多 样 性 ,但 主要 有 以 下 三 种 形式 :@ 微 分 方程 模型 ;@ 传 递 函 数 模 
型 ;@ 状 态 空间 模型 。 在 研究 随机 系统 的 测量 、 估 计 和 控制 问题 时 ,状态 估计 器 和 最 
优 控制 器 都 需要 采用 计算 机 实现 ,为 了 实时 进行 估计 和 控制 , 频 域 系 统 模型 不 能 适 
应 上 述 要 求 ,系统 模型 必须 是 时 域 模型 。 与 传递 函数 相 比 ,状态 空间 模型 解决 了 多 
输入 多 输出 系统 的 描述 问题 ;与 微分 方程 相 比 , 它 在 符号 的 运用 和 运算 上 也 更 为 简 
便 。 此 外 ,状态 空间 模型 与 任何 频率 变换 方法 相 比 更 接近 物理 现实 。 因 此 ,最 优 估 
计 理 论 的 提出 和 研究 主要 采用 基于 状态 空间 描述 的 模型 。 在 以 后 的 学 习 过 程 中 将 
会 看 到 ,这 种 模型 比较 适合 随机 系统 的 求解 和 优化 。 还 有 一 个 基本 事实 是 ,状态 空 
间 模 型 是 由 卡尔 曼 首先 采用 的 ,卡尔 曼 滤波 器 也 正 是 基于 这 个 模型 进行 推导 而 得 
到 的 。 


5.1.1 连续 系统 模型 


1. 连续 线性 时 不 变 系 统 模型 

经 典 控制 和 现代 控制 理论 已 经 对 三 种 系统 模型 进行 了 详细 的 论述 , 下面 以 线性 
连续 系统 模型 为 例 ,简单 回顾 这 三 者 之 间 的 关系 。 

了 ) 微 分 方程 模型 

以 最 简单 的 系统 模型 为 例 ,考虑 线性 时 不 变 单 变量 模型 ,其 微分 方程 如 下 
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Tzw Fas E ey a 
== Puto +a TP+ +oult) 
AP, u) 为 + 时 刻 的 系统 输入 信号 ; =G) 为 上 时 刻 的 系统 输出 信和 号。 
2) 传 递 函数 模型 
RCG. 1. 1) 是 一 个 线性 时 不 变 系统 ,如 果 令 其 初始 条 件 为 0, 经 过 拉 普 拉 斯 变换 ， 
则 可 以 得 到 系统 的 传递 函数 如 下 
Z(s) = G(YU(s) (5.1.2) 
RH, Z(s) = Z[z(t)],U(s) = ZB[u(t)], 而 


= Ce? 二 cos HH 
G@ 六 十 aris" + +a 6.1.3). 


3) 状 态 空间 模型 
WR n> p, HRG. 1. 1) 描 述 的 系统 可 以 转化 为 如 下 的 一 阶 向 量 微分 方程 
X(t) = Ax (t) + Bu (t) (5. 1. 4(a)) 
z(t) = CeG) C5. 1. 4(b)) 
这 就 是 状态 空间 模型 。 式 中 , xG) 为 状态 向 量 , 包 括 个 状态 变量 ,它们 和 输入 信号 
一 起 完整 地 确定 该 控制 系统 的 运动 ;矩阵 系数 为 


0 1 0 … 0 0 
0 0 1 … 0 0 
4 一 | i r H ; |,B= |: (5. 1. 5(a)) 
0 0 0 … 1 0 
Za —a 一 0 ° — ae. 1 
C=[c c, 0…0] (5.1.5(b)) 


式 (5.1.4) 提 供 了 由 微分 方程 模型 转化 为 状态 空间 模型 的 一 般 方法 。 式 (5. 1. 4) 可 
看 做 是 一 个 用 nn 维 向 量 微分 方程 描述 的 控制 系统 。 可 以 看 出 ,对 于 一 个 n 阶 系统 ,在 
采用 状态 空间 模型 描述 时 ,和 需要 个 状态 变量 。 实 际 上 ,状态 变量 的 数目 可 以 大 于 
7, 即 状态 向 量 中 可 以 增加 额外 的 状态 变量 ,只 是 额外 增加 的 状态 变量 将 不 具有 可 观 
测 性 和 可 控制 性 。 

对 于 状态 空间 模型 ,需要 注意 这 样 一 点 。 由 于 系统 模型 可 以 用 微分 方程 来 描 
述 ,因此 从 数学 的 角度 上 讲 , 如 果 希 望 了 解 系统 某 初始 时 刻 t 之 后 任意 时 刻 的 状态 ， 
则 需要 知道 系统 在 t .时 刻 的 状态 值 x(m) = zo， 即 初始 条 件 。 

可 以 验证 ,状态 空间 模型 式 (5. 1. 4 和 传递 函数 式 (5. 1. 3) 之 间 存在 如 下 关系 

G(s) = C[sI —AT'B G. 1. 6) 

RG. 1. 6) 表 明 , 一 个 控制 系统 传递 函数 的 极点 等 于 状态 方程 系数 矩阵 A 的 特征 根 。 
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因此 ,在 一 个 nn 阶 控制 系统 中 ,如 果 没 有 零点 和 极点 相 消 的 情况 ,可 以 采用 n 维 状态 
空间 模型 来 描述 。 这 两 种 模型 具有 相同 的 输入 和 输出 信号 。 
例 5.1 EARRA BO 


an =+1 
GG) = FF iios Tal 


试 求 其 状态 空间 模型 。 
W 由 式 (5.1.3) 可 知 a 一双 ai = Gunso = lsa 二 +, 据 此 可 按 式 (5.1.4) 写 


出 状态 空间 模型 
Bol- [ws -mboth 


| 


z(e) = [1 aÉ w 
1 


2. 连续 线性 时 变 系 统 模型 

系统 模型 式 (5. 1. 4) 是 最 简单 的 线性 模型 ,其 中 的 系数 矩阵 与 时 间 无 关 , 即 是 时 
不 变 的 。 如 果 系 数 和 矩阵 是 随时 间 变化 的 , 则 构成 如 下 的 时 变 系统 模型 

R) = Ax) + BW) ,x(to) = xo (S.1.7(a)) 
z(t) = C(t)x(z) (5.1.7(b)) 

应 该 指出 ,对 于 时 变 系统 来 说 ,不 能 用 传递 函数 法 描述 系统 模型 。 

实际 的 系统 往往 是 时 变 的 ,但 是 在 某 些 条 件 下 可 以 近似 为 时 不 变 系统 ,从 而 简 
化 数学 处 理 过 程 。 

3, 连续 非 线 性 系统 模型 

RG. 1. 4) 和 式 (5. 1. 7) 描 述 的 都 是 线性 系统 。 对 于 非 线 性 系统 。 其 状态 空间 
描述 的 系统 方程 和 输出 方程 为 

RC) = f[x(0O,u(O,t],x(t) = x (5. 1. 8(a)) 
z(t) = h[x(t) ult), t] (5. 1. 8(b)) 
RP, fe, es JAA, e 1 是 关于 状态 和 输入 的 非 线 性 函数 。 

实际 的 动态 系统 很 复杂 ,系统 模型 往往 是 非 线 性 的 。 直 接 处 理 非 线性 模型 极其 
困难 ,而 且 不 容易 得 到 精确 解 。 在 工程 应 用 中 ,为 了 使 算法 和 计算 简化 ,在 精度 允许 
的 范围 内 ,常常 将 非 线性 系统 模型 近似 化 为 线性 系统 模型 ,再 利用 成 熟 的 线性 系统 
处 理 方法 。 关 于 非 线 性 模型 的 线性 化 方法 ,将 在 后 面 介绍 。 

例 5.2 卫星 的 轨迹 可 以 用 ~ 和 8 两 个 极 坐标 变量 描述 ,其 中 x 是 卫星 到 地 心 的 
距离 , 0 是 卫星 和 地 心 的 连 线 相对 于 参考 坐标 轴 的 角度 。 假 定 卫 星 具有 径 向 和 切 向 
的 推力 控制 u, O 和 w(z), 试 建立 卫星 轨迹 控制 的 系统 模型 。 

解 根据 力学 规律 ,卫星 的 运动 方程 可 写 为 
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G 
ra) 


O =— Z Gr ELS 
Ea) 一 IOO Hgg 


产 ( =r +u, (t) 


选择 状态 变量 如 下 
= = rT = fszt; = 0,z, = Ê 
参考 系统 模型 式 (5. 1. 7(a)) ,可 得 卫星 轨迹 控制 的 系统 模型 如 下 
x(t) 


ah (t) e G 
aw) t) -ZO Hule) 


3 (t) z(t) 
s (t). 2 


1 
a5” Cx (t) + zo“ a) 





5.1.2 离散 系统 模型 


以 上 针对 连续 系统 介绍 了 线性 系统 模型 和 非 线 性 系统 模型 。 在 测量 和 控制 系 
统 中 ,通常 采用 数字 计算 机 进行 实时 计算 ,为 此 需要 建立 和 连续 系统 等 效 的 离散 系 
统 模型 。 
系统 的 动态 方程 是 系统 物理 过 程 的 数学 描述 ,是 使 方程 成 立 的 输入 与 输出 量 的 
关系 表达 式 。 换 句 话 说 ,方程 是 系统 物理 过 程 的 隐 式 表示 ,而 方程 的 解 是 显 式 表示 ， 
即 它们 在 本 质 上 是 一 致 的 ,分 析 方 程 的 解 与 分 析 方 程 本 身 是 等 效 的 , 故 也 将 方程 的 
解 称 为 状态 方程 。 离 散 系统 方程 实际 上 是 系统 的 状态 值 在 任意 两 个 相 邻 离散 时 刻 
的 递 推 关系 ,因此 ,如 果 得 到 了 连续 系统 方程 的 解 ,也 就 得 到 了 离散 系统 方程 。 
利用 常 微分 方程 的 知识 ,求解 连续 时 变 系统 (5. 1. 6(a)) ,可 得 
x(D = eoo Elh) +f AD Bu de (5.1.9) 
式 中 , 右 端 第 一 项 代表 系统 初始 条 件 引 起 的 响应 ,第 二 项 代表 控制 输入 引起 的 响应 ， 
A 定义 为 
ee = HAO HER an AOD a 
& ee = DU, t), PERG. 1. 9) 离 散 化 ,可 得 
x(ta) = Olten st) xCt) + [ea DBO dr aG 6.1.10) 
这 里 假定 在 t € [& ,trn] ,控制 作用 为 常数 , 即 u(t) 一 wz) 。 
在 式 (5.1. 10h, H ERE to $ [od ,DDB(Ddr = B(), 可 得 (5.1.6) 中 
状态 方程 和 输出 方程 相应 的 离散 形式 , 即 差 分 方程 
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x(&+ 1) = @(¿ + 1,k)x(&) + B(&)u(&) (5. 1. 11(a)) 

alk) = C(k)x(k) (5. 1. 11(b)) 

从 上 述 的 讨论 可 以 看 出 ,在 用 状态 空间 模型 完整 描述 一 个 动态 系统 时 ,需要 两 

个 方程 :状态 方程 和 输出 方程 。 用 状态 方程 描述 系统 的 状态 与 输入 之 间 的 关系 ,用 

输出 方程 描述 系统 状态 与 输出 之 间 的 关系 。 状 态 方程 主要 反映 的 是 系统 本 身 的 特 

性 ,因此 又 称 为 系统 方程 ;输出 方程 一 般 用 于 描述 外 界 对 系统 状态 的 观测 过 程 ,因此 

又 称 为 观测 方程 或 测量 方程 。 任 何 一 个 动态 系统 都 可 以 由 系统 方程 和 测量 方程 描 
述 其 内 部 的 规律 。 


5.2 随机 动态 系统 模型 


通过 对 确定 性 动态 系统 的 讨论 可 知 ,完整 地 描述 一 个 动态 系统 至 少 需要 两 个 方 
程 :状态 方程 和 输出 方程 。 在 实际 的 物理 系统 中 ,除了 已 知 的 控制 作用 u(z) 以 外 ,还 
存在 一 些 随机 性 的 干扰 作用 , 称 为 系统 噪声 w(t)。 测量 方程 也 存在 着 随机 性 干扰 , 称 
为 测量 噪声 v(z)。 这样 ,就 需要 在 确定 性 系统 模型 中 增加 系统 噪声 和 测量 噪声 ,这 
就 构成 了 随机 动态 系统 模型 。 

为 了 方便 讨论 问题 ,下 面 仍然 以 线性 系统 为 例 。 从 上 面 对 确 定性 系统 的 讨论 可 
知 ,系统 方程 实际 上 是 一 个 一 阶 的 常 微分 矩阵 方程 ,对 于 带 有 随机 噪声 的 随机 连续 
系统 和 离散 系统 ,就 是 随机 微分 方程 和 随机 差分 方程 。 


5.2.1 线性 随机 微分 方程 
. 考虑 随机 连续 线性 动态 系统 ,如 果 不 考虑 确定 性 控制 作用 , 则 系统 模型 可 写 为 
20) = ADX) HCAW) 6.2.1) 
式 中 , x(z) 为 n 维 状态 向 量 , wW) 为 p 维 高 斯 白 噪声 干扰 向 量 ,在 +€ 本 的 时 间 区 间 
内 均值 为 0。 
式 (5.2.1) 可 以 改写 为 
dx(2) = A(OxÜ(2)dz + G2 dp) (5.2. 2) 
式 中 , P(O) 为 扩散 过 程 ,其 扩散 系数 在 + € 工 的 时 间 区 间 内 为 CC 。 
RG. 2. 2) 是 一 个 随机 微分 方程 ,根据 常 微分 方程 的 解法 ,其 理论 解 为 
E = ox + AOO 
G A = Dlt, to), 
X0) = Dlt, to) xlt) +| owed (5.2.3) 


式 中 的 状态 转移 矩阵 B(z,to) 满足 以 下 齐 次 方程 
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OG, t) = AHP, t) (5. 2. 4) 
HOG, t) 具有 如 下 性 质 : 
(CD Olost) = Li 
(2) Ø, Øl, to) = Ø, to); 
(3) [P0] = @(z,2), 
虽然 得 到 了 随机 微分 方程 的 形式 解 , 即 式 (5. 2. 3) ,但 它 还 是 一 个 随机 过 程 。 要 
完整 描述 它 , 还 需要 计算 它 的 统计 特性 ,包括 数学 期 望 m,(t) 和 协 方差 P.(i) 。 
x(z) 的 数学 期 望 为 
m.) = ELx(D] = @CG,t)E[LxCG)] + 下 | oo,accodpco] TAA 
= Di,to)m (to) 
式 中 ,等 式 右 端 第 二 项 的 随机 积分 的 均值 为 0。 
协 方差 ExT O] 应 当 包括 四 项 。 由 于 扩散 过 程 和 xG) 互相 独立 ,因此 它 
们 之 间 的 互相 关 函 数 应 该 等 于 0, 因 此 x(z) 的 协 方差 矩阵 为 
ELx(CDxT(D] = OC, to) ECx Cto) xT Cto) JOT Ct, to) 
+P ee,occogeocreoera,oac 
考虑 到 
E[x(2)x™ (1)] = P, (t) +m.G)m1 (O 
E[x(t)x! Cto) ] = P; (to) +m, (to) mi Cto) 
44 
P,() = ØC, to)P, (T Ctto) +| oud6W Gr OT Odde (5. 2.6) 


若 x(to) 是 高 斯 随机 变量 , 则 在 确定 的 时 间 截 面 t 内 ,x(z) 也 为 高 斯 随机 变量 。 
如 果 取 两 个 时 间 截 面 z, > t 2 to, 则 随机 过 程 xG) 可 以 写 为 


x)= Dlha sto) xlt) +Ë oa, DGP) 
= Dinal) + |" D DEd 
相应 的 相关 函数 为 
E[xCGo)x*(6)]= @G,n)E[xC(a)z7G)1+ E| | ,dG dB) Tn )] 
看 


= @(t,t )E[x(0a)x!(a)]J 
或 写 为 P.G) = Olt ,ti)P,(n) (5. 2.7) 
以 上 随机 微分 方程 的 解 也 适用 于 时 变 系统 。 


5.2.2 线性 随机 差分 方程 
对 方程 (5. 2. 3) 在 离散 时 刻 < n < t, < = < t 二 … 采 样 ,得 
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z(a) = Dim tx) + | Bm GO WD dr 5.2.8) 


当 采 样 间隔 T = tn 一 较 小 时 ,可 以 认为 系统 干扰 (WO), t > to) 在 [a ta] 中 是 
常 值 w(t) 。 即 对 于 在 到 上 一 tl 一 0,1,…)，(5.2.8) 可 写 为 
Xle) = Olten rta) x(t) +f ocs st)GCr)diw (t) (5. 2.9) 
定义 : Xe = A) Xe = x(&),w = W) Drin = Olti) Das, = 
[H oca Gea, 
则 得 系统 的 离散 时 间 模 型 , 即 随机 差分 方程 为 
Xi = @;ax, 十 了 He (5. 2. 10) 
AP, Oui 是 n X n EREEREER w, 是 p 维系 统 随机 于 扰 序 列 , 为 零 均 
值 的 高 斯 白 噪声 序列 ; Tua, E n X p 维 的 系统 一 步 转移 干扰 矩阵 。 
根据 随机 系统 模型 式 (5. 2. 10) ,可 以 计算 xx 的 数学 期 望 和 协 方差 如 下 
m,(k+ 1) 一 Øm, Ck) 6. 2.11) 
P, (k +1) = Orri aP 3 (k) Dkn, Tai ODIE a (5. 2. 12) 


5.2.3 ”随机 动态 系统 模型 的 一 般 形 式 


上 面 分 别 由 随机 微分 方程 和 随机 差分 方程 描述 了 连续 系统 和 离散 系统 的 特性 。 
如 前 所 述 ,完整 描述 一 个 动态 系统 需要 系统 方程 和 测量 方程 。 下 面 将 测量 方程 加 
入 ,以 连续 系统 为 例 , 讨 论 随机 动态 系统 数学 模型 的 各 种 形式 。 
1. 一 般 系 统 模型 
2A) = fx) u) wet) pt] (5. 2. 13(a)) 
20) = AEX) ult) ,0 (D) ,0] (5. 2. 13(b)) 
这 是 随机 动态 系统 数学 模型 最 一 般 的 形式 。 式 (5. 2. 13) 中 , x(z) JE n Ht 0383518] 
量 ; xG) 是 m 维 的 系统 测量 向 量 ; w) 是 p 维系 统 随机 干扰 向 量 ,也 称 为 系统 噪声 ; 
v (2) 是 m 维 的 系统 测量 噪声 向 量 ; xz) JE: r 维 的 确定 性 控制 输入 向 量 。 f[.] 和 
h[*] 是 形式 已 知 的 系统 函数 和 观测 函数 。 若 f["] 和 有 h[*] OWO v (D 和 
ulz) 的 线性 函数 , 则 模型 为 线性 模型 ; 若 二 者 均 为 非 线性 函数 , 则 模型 为 非 线 性 模 
型 ;车 二 者 其 一 个 为 线性 ,而 另 一 个 为 非 线 性 , 则 模型 为 混合 性 模型 ,一 般 也 称 为 非 
线性 模型 。 
2. 线性 系统 模型 
了 ) 带 控制 输入 的 线性 时 变 系统 模型 
若 在 一 般 模型 中 , fL - J 和 h["] 为 x(t)、w(z)、v G) 和 ulz) 的 线性 函数 , 则 在 确 
定性 输入 和 随 宙 干 扰 情 况 下 线性 系统 的 数学 模型 为 ” - 
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X(t) = AMX) HBU) 十 CCD)w(t) (5. 2. 14(a)) 
z(t) = HOX) HDU) +o Ct) (5. 2. 14(b)) 
式 中 , 4(D BOGO) HO) 和 D(z) 分 别 为 时 间 上 的 连续 系统 矩阵 。 
2) 带 控制 输入 的 线性 定常 系统 模型 


EAO BOGO HO 和 D(z) 均 与 时 间 无 关 , 则 有 如 下 的 定常 线性 系统 的 数 
学 模型 , 即 





2) = Ax (t) + Bu Ct) 十 Gw(D) (5. 2. 15(a)) 
z(t) = Hx (t) + Du (t) +v (t) (5. 2. 15(b)) 
3) 自 由 状态 线性 时 变 系统 模型 
若 不 考虑 确定 性 控制 输入 , 则 有 如 下 的 自由 状态 线性 系统 模型 
EA) = AHX) + GW) (5. 2. 16(a)) 
zt) = Hx) Ho e) 6. 2. 16(b)) 
4) 自 由 状态 线性 定常 系统 模型 
AOGA 和 H(z) 均 与 时 间 无 关 , 则 有 如 下 的 自由 状态 定常 线性 系统 模型 
i X(t) = Ax (t) 十 GwCO) (5. 2. 17(a)) 
z(t) = Hx (t) +o (t) (5. 2. 17(b)) 


3. 关于 噪声 的 假设 

上 面 介绍 了 动态 系统 模型 的 一 般 形 式 。 当 系统 的 初始 状态 xG) 及 系统 干扰 
WCE) 和 测量 噪声 v(z) 是 随机 过 程 时 ,系统 的 微分 方程 便 是 随机 微分 方程 。 此 时 ,只 
有 统计 意义 上 的 分 析 才 有 效 ,因此 使 问题 的 分 析 过 程 复 杂 而 困难 。 为 了 使 问题 简 
化 ,需要 对 系统 干扰 ,测量 噪声 及 系统 的 初始 状态 作 一 定 的 假设 。 

(1) 系 统 干 扰 (W0) t> to) 和 测量 噪声 (vC) st > to) 是 零 均值 或 非 零 均值 的 白 
噪声 过 程 或 高 斯 白 噪声 过 程 , 即 


FOWD] = OR EOD] = a. ) 6. 2. 18) 
Cov[ w(t),w(r) ] = QDS — r) 
E[o (2)] = 0 或 [v (D] = z, | 6.2.19) 


Cov[u (0) ,o (r) ] = ROSG — r) 
RP, QG) 为 p Xp 维 对 称 非 负 定 和 矩阵 ,是 w(z) 的 方差 强度 矩阵 ; RO) J m X m XÍ 
称 正定 矩阵 ,是 v (2) 的 方差 强度 矩阵 ; 3(z 一 rt) 是 犹 拉克 6 函数 , 即 


0， ~ 
a=) = | t*r aÉ oa =1 
cap £= a 
(2) (w(0),t > to} 与 (o (),t > ts) 互 不 相关 或 8 相关 , 即 
Cov[w(t) ,o (z) ] = 0 (5. 2. 20) 
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Cov[Lw(D,o(nD] 一 SCD6CG 一 让) (5. 2.21) 
(3) 系 统 的 初始 状态 xGo) 是 正 态 分 布 或 某 种 已 知 分 布 的 随机 向 量 , 其 均值 向 量 
和 方差 阵 为 
ELx(t)] = m,(t), Var[x(to)] = P, (to) (5. 2.22) 
(4) (w(20)st > to) 和 (o O) ;t > to) 均 与 初始 状态 xG) 无 关 , 即 
Cov[x(t) ,w(z) ] = 0 (5. 2. 23) 
Cov[x(to) o (t) J = 0 (5. 2. 24) 
以 上 关于 噪声 的 假设 有 如 下 几 点 说 明 : 
O 假设 噪声 为 白 噪 声 , 则 噪声 过 程 是 时 间 不 相关 的 ,因此 噪声 过 程 的 方差 阵 为 
对 角 阵 ( 即 非 对 角 线 上 的 元 素 均 为 0) ,这 样 可 以 使 算法 大 大 简化 。 
@ 假设 噪声 为 高 斯 噪声 , 则 噪声 过 程 可 以 仅 由 其 均值 和 协 方差 描述 , 且 对 于 线 
性 系统 ,其 输出 也 是 高 斯 过 程 。 但 是 ,实测 结果 表明 ,系统 噪声 和 测量 噪声 往往 不 是 
高 斯 噪声 ,而 是 一 阶 或 高 阶 马尔 可 夫 过 程 。 这 时 ,可 以 用 高 斯 白 噪声 通过 假想 的 线 
性 环节 ( 称 为 成 形 滤波 器 ) 产 生 这 样 的 随机 过 程 。 应 该 指出 ,实际 的 系统 并 不 存在 这 
样 的 线性 环节 。 引 人 成 形 滤波 器 只 是 为 了 把 系统 噪声 和 测量 噪声 变换 为 高 斯 白 噪 声 。 
图 系统 噪声 和 测量 噪声 与 系统 初始 状态 不 相关 ,这 在 多 数 情况 下 是 具有 实际 意 
义 的 。 因 为 系统 干扰 一 般 是 在 建 模 过 程 中 产生 的 误差 ,不 应 该 与 系统 的 初始 状态 有 
关 ; 测 量 设备 属于 外 围 设备 , 它 的 测量 误差 也 不 应 该 与 初始 状态 有 关 。 


5.3 模型 的 转化 


5.3.1 连续 系统 模型 转化 为 离散 系统 模型 


在 很 多 情况 下 得 到 的 系统 模型 是 连续 形式 ,但 是 在 估计 和 控制 问题 的 实际 应 用 
中 ,为 了 便于 讨论 和 计算 机 处 理 ,经 常 需要 将 连续 系统 模型 进行 离散 化 处 理 。 

系统 的 离散 化 方法 主要 有 两 种 

(1) 在 线 离散 化 。 在 滤波 算法 的 递 推 执行 过 程 中 ,利用 求解 常 微分 方程 的 数值 
算法 ,如 龙 格 - 库 塔 (Runge-Kutta) 法 ,通过 实时 计算 连续 系统 在 每 个 离散 时 刻 的 状 
态 值 而 实现 ; 

(2) 离线 离散 化 。 在 离线 状态 下 ,通过 求解 常 微分 方程 以 计算 随机 动态 系统 的 
状态 转移 矩阵 ,从 而 得 到 各 离散 时 刻 的 系统 状态 值 。 

其 中 ,第 一 种 离散 化 方法 属于 数值 算法 ,所 以 是 一 种 近似 求解 方法 , 解 的 精度 与 
数值 算法 的 阶 数 和 离散 化 步 长 有 关 , 优点 是 不 必 手 动 计算 状态 转移 矩阵 , 因而 便于 
计算 机 实现 ;第 二 种 离散 化 方法 属于 解析 的 方法 ,相对 第 一 种 方法 更 精确 ,常用 于 理 
论 分 析 。 
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下 面 以 线性 系统 为 例 ,讨论 系统 方程 的 第 二 种 离散 化 方法 。 
对 于 自由 状态 时 变 线性 系统 模型 
x) = AG)xGO + GG)w(t) (5. 3.1(a)) 
z(t) = H(zt)xGt) +v (t) (5.3.1(b)) 
考虑 其 离散 化 过 程 。 
实际 上 ,5. 2 节 已 经 涉及 这 个 问题 ,由 随机 微分 方程 导出 随机 差分 方程 的 过 程 就 
是 对 系统 方程 式 (5. 3. 1(a)) 的 离散 化 。 因 此 ,这 里 不 再 重复 叙述 ,直接 得 到 离散 系统 
方程 
Xen = Deraxs + Tr rw (5. 3. 2) 
由 于 测量 方程 式 (5. 3. 1(b) ) 是 简单 的 代数 方程 ,因此 它 的 离散 形式 与 连续 形式 
相同 , 即 离散 测量 方程 为 
Zen = HX + vm (3.3 
式 中 , wh 是 m 维 随机 测量 噪声 序列 ; Hen J t = tin 时 刻 的 m X n 维 测量 矩阵 。 
当 考 虑 到 有 确定 性 输入 项 u(t) 时 ,离散 系统 方程 式 (5. 3. 2) 变 为 
Xin 一 Dear 十 Wn 十 了 He (5. 3, 4) 
RP, ui Jr 维 控 制 向 量 序列 ; Wn 是 n Xr 维 控制 一 步 转移 矩阵 。 此 时 ,测量 方程 
不 变 。 
对 于 线性 定常 系统 式 (5. 2. 15) 和 式 (5. 2. 17) , 式 (5. 3. 2) 及 式 (5. 3. 3) 可 进一步 
表示 为 


Xin = Ox, + Wu, + Tw (5. 3.5(a)) 
Zen = Hx +U (5. 3. 5(b)) 
和 
Xin = @x, + Iw, (5. 3. 6(a)) 
Zi = Hrin Hven (5. 3. 6(b)) 


RH, O= (T= xa 一 4 为 采样 周期 ), 于 一 [| edcjBr 一 [| eare, 


类 似 于 连续 系统 模型 ,对 于 上 述 离散 系统 模型 ,对 其 系统 干扰 和 噪声 也 有 类 似 
的 假设 和 性 质 。 
(1) w 和 wx 是 零 均值 或 非 零 均值 的 白 噪 声 或 高 斯 白 噪声 随机 序列 , 即 
E[w,] = 0 R E[w,] = pu 
R... (k,j) = Qiðy } 
E[w] = 0 R E[u] = e 
Ro (ksj) = Rids 
式 中 , @ 为 p X p ERRETINAN , 4533 fn EBE; R, 是 m Xm 维 观 测 噪声 
方差 矩阵 ; 5 是 狄 拉克 6 AR, Bl 





G; 3.7) 


(5. 3. 8) 


` 118 + 最 优 估计 理论 





_ J, kj 
% = li, k=; 
(2) w, 和 ms 是 互 不 相关 或 $ 相关 , 即 
R..(k,j) = 0 (5. 3. 9(a)) 
或 
及 (kJ) = S,ó, (5. 3. 9(b)) 


(3) 系 统 的 初始 状态 z 是 正 态 分 布 或 某 种 已 知 分 布 的 随机 向 量 ,其 均值 向 量 和 
方差 阵 为 
E[xo] = ,Var[xo] = P(0) (5. 3. 10) 
(4) w 和 mx 均 与 系统 初始 状态 xo 无 关 , 即 
Ræ (OA) 一 0 (5. 3. 11(a)) 
Ra» (0,k) = 0 (5. 3. 11(b)) 


5.3.2 离散 系统 模型 转化 为 连续 系统 模型 


前 面 的 讨论 ,将 随机 线性 系统 的 状态 方程 离散 化 ,得 到 了 随机 线性 离散 系统 的 
状态 方程 。 在 某 些 情况 下 ,为 了 理论 研究 或 其 他 目的 ,需要 将 已 知 的 离散 系统 模型 
转化 为 连续 系统 模型 。 这 时 ,可 以 将 连续 系统 看 作 离 散 系统 当 采 样 周期 趋 于 零 时 
的 一 种 极限 情况 , 即 当 采样 点 稠密 或 采样 间隔 趋 于 0 时 ,对 离散 系统 取 极限 ,就 可 以 


得 到 连续 系统 模型 。 
仍然 以 自由 状态 线性 时 变 系统 模型 为 例 
X(t) = AG) xlt) +G(Ow(zD (5. 3. 12(a)) 
z(t) = Hx) +v (t) (5. 3. 12(b)) 
假设 其 离散 化 后 所 得 的 线性 离散 系统 模型 为 
Xi = Dx + Deawe (5. 3. 13(a)) 
Ze = 再 ext + Vt (5. 3. 13(b)) 


为 了 由 离散 系统 求 连续 系统 模型 ,首先 研究 二 者 之 间 的 对 应 关系 。 

1 两 种 系统 模型 系数 矩阵 与 转移 矩阵 之 间 的 关系 

由 于 转移 矩阵 Dri 和 I 与 原 连续 系统 的 系数 矩阵 之 间 应 满足 如 下 关系 : 
Orna = A(D Dr. 
Ore = @,, = I, 


naa = Bm ,DG de 
K 


S i = txt = t+ At, 可 将 Oria 一 加 (二 At Te = TOH At,t) 在 上 时 刻 
按 泰 勒 公式 展开 , 即 
C+ Ar, = Bi,t) +O, At + OC) (5. 3. 14) 
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TG+ Art) = r,t) HEG, DAHO) (5. 3. 15) 
因为 
Olt.) = I, 
B11) = AOO, t) = AG) 


re = [ea,oGeoar = oç, 


raw = 2 (f'o Dewar) 


所 以 ,忽略 At 的 高 阶 项 时 ,可 得 如 下 近似 关系 
@G + At,t) 一 到 十 4A(CDAt (5. 3. 16) 
T(t+ Art) = GOA (5. 3. 17) 
2) 两 种 系统 模型 之 间 噪 声 均值 和 相关 函数 的 关系 
连续 系统 式 (5. 3. 12) 中 , p 维 白 噪声 过 程 (wz) ,t > 0) 的 均值 和 相关 函数 为 





=G) 


E[w(t)] = pult) Raw ltor) = QE — r) (5. 3. 18) 
离散 系统 式 (5. 3. 13) 中 , p 维 白 噪声 序列 (wW), k > 0) 的 均值 和 相关 函数 为 
E[w(k)] = pulk) Re (ksj) = Qidy (5. 3. 19) 
t 为 连续 时 间 , 假 设 其 初始 值 为 , 终 值 为 i,, WJ 
hb = t + kAt 


如 果 将 有 限时 间 区 间 Co ,t,] 分 成 等 间隔 的 n 段 , 即 


-hh 


n= 


At 

则 相当 于 二 0 时 的 + 值 ,而 w== 十 nAt 就 相当 于 k = n BRY e 值 。 因 此 , 白 噪 
声 序列 (wi,k 0} 可 以 认为 是 存在 于 区 间 Costa] 上 的 一 个 分 段 常 值 白 噪声 过 程 
(WO) sto < t< n), MÆ [tost] Bj n PARAE, i = to HRAC = 0,1,2,---,m) 

又 是 一 个 白 噪声 序列 (m0 < k < n), 
另 一 方面 ,如 果 区 间 长 度 [to, 思 ] 不 变 , 而 使 n-> co, Bl At-> 0, 则 分 段 常 值 白 品 
声 过 程 wz)， 即 白 噪声 序列 w, 的 极限 是 一 个 白 噪声 过 程 (Wa) ,to << : < t), 即 有 
lim{w G) ,tb < < s) = (w(t),t < t < t,) (5.3.20) 


Aro 
下 面 分 析 白 噪声 过 程 w(t) 和 和 白 噪声 序列 w, 的 均值 和 相关 函数 阵 之 间 的 关系 。 
如 果 一 个 白 噪 声 过 程 是 由 一 个 白 噪 声 序列 (分 段 常 值 白 噪声 过 程 ) 当 采 样 周期 
Az ATF 0 时 的 极限 得 到 的 ,由 于 均值 与 采样 周期 无 关 , 故 有 
ELW) = p(t) = Efm) = wa 6. 3. 21) 
即 两 者 均值 相等 。 
白 噪 声 序列 w, 的 相关 函数 阵 为 
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Re (ksj) = Qòy = Qar i (5. 3. 22) 
由 于 
lim 98. 一 8 一 (5. 3. 23) 
而 在 Az — 0 时 , 白 噪声 序列 rw 的 极限 为 白 噪声 过 程 w(z)，, 其 相关 函数 阵 为 
Re G) = Q(B — t) (5. 3. 24) 


由 式 (5. 3. 22) 及 (5. 3. 24) 可 得 , wi 与 w(t) 相关 函数 之 间 的 关系 为 
limQ@,Ar = Q0) 


Bp 
Q = lim 22 (5. 3. 25) 
3) 两 种 系统 模型 之 间 的 关系 
假设 已 知 随机 线性 离散 系统 的 数学 模型 为 式 (5. 3. 13) , 即 
Xt) = Danis ti x) HE Ge st DWA) (5. 3. 26(a)) 
z(ta) = HO) xr) + 0 (ta) (8.3. 26(b)) 
噪声 过 程 为 
E(w} = za Raw (ksj) = Qidy 
Elo,) = ga Ru (ksj) = Ridy 
如 果 令 


b 一 tsten = t+ At 
并 且 用 分 侦 常 值 白 噪声 过 程 代替 W) 和 {vi(z 十 Az)) 去 代替 噪声 序列 {w(t)} 
和 (oaa) WRG. 3. 26) 可 以 写 为 
xG + At) = OGHA tx) +G A Ow (t) (5. 3. 27(a)) 
HAD = HUH ADx(z+ A) HHA) (5.3.27(b)) 
将 式 (5. 3. 27(a)) 两 端 同 时 减 去 x(z) 并 除 以 Az, 得 
EAD = P+ ND hy) LTG AED) (5,3, 28) 








将 式 (5. 3. 16) 和 式 (5. 3. 17) 代 入 式 (5. 3. 28) ,得 








zG-+AD TEO AD Ate cr) + ED Ayes) (5. 3. 29) 

令 At~ 0, 根据 式 (5. 3. 20) 可 得 式 (5. 3. 29) 的 极限 ,再 对 (5. 3. 27(b)) 取 极限 ,可 得 
O = ACDx(D) +G(D)w(D (8.3. 30(a)) 

a = HOOD +o (O (5. 3. 30Cb)) 


可 见 , 随 机 线性 连续 系统 模型 就 是 随机 线性 离散 系统 模型 在 采样 周期 Az -> 0 的 
极限 。 
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白 噪声 过 程 w(z) A o (D 的 均值 向 量 与 相关 函数 阵 为 
E(w(2)) = pult) Raw Gr) = QC — r) 
E(o (O) = mt), Ra ltir) = RODG — z) 
式 中 , QG) 和 R(z) 与 随机 线性 离散 系统 中 的 Q, MR 之 间 的 关系 为 
QG) = imQ, At, RO) = HMR, At 
需要 说 明 的 是 , QO A Q, 的 含义 是 不 同 的 : Q(z) 是 谱 密度 矩阵 ,而 Q, 是 协 方差 
和 矩阵 ,它们 的 单位 也 不 同 , 相 差 (1/ 时 间 )。 通 过 乘 以 狄 拉克 函数 aG — r), 可 以 将 谱 
密度 矩阵 转化 成 协 方差 矩阵 。 


S.3.3 非 线性 模型 线性 化 


此 处 仅 以 非 线 性 系统 模型 为 例 
X(t) = f[x(O ,:] + gix), tlw) (5.3.31(a)) 
z(2) = h[x(0),t] +o (2) (5.3.31(b)) 


考虑 非 线性 模型 的 线性 化 问题 。 对 非 线性 模型 进行 线性 化 的 方法 不 止 一 种 ,常见 的 
是 将 非 线性 函数 f(z) 在 某 固定 点 zo 处 展开 成 泰勒 (TaylomD 级 数 ,并 截取 一 阶 项 ,从 
而 得 非 线性 函数 的 线性 近似 。 

根据 泰勒 级 数 展开 定理 ,车 已 知 函 数 f(z) 在 某 已 知 点 z, 处 无 穷 次 可 微 , 则 
f(z) 可 以 展开 成 泰勒 级 数 , 即 


FD = feo) f aaa) Rt 


(S. 3. 32) 
H z HE zo 的 邻 域内 时 , (zx 一 zo)?，,…,(z 一 zo)" 为 高 阶 无 穷 小 ,可 以 忽略 , 则 f(z) 
可 以 近似 表示 为 线性 形式 , 即 
FCE) = flt) + f (aa)(z — zo) (5.3.33) 
显然 , z Ë zo RE ERPE, lk, 3 RRRA REEE 
该 选择 在 固定 点 附近 作 级 数 展开 。 
在 最 优 估计 理论 中 ,对 于 固定 点 ze 的 选择 ,一 般 有 两 种 : 标 称 值 和 估计 值 。 这 两 
种 固定 点 的 选取 方法 对 应 着 两 类 线性 化 方法 :围绕 标 称 值 的 线性 化 方法 和 围绕 估计 
值 的 线性 化 方法 。 
所 谓 标 称 值 ,是 指 方程 在 没有 干扰 时 推算 出 来 的 理想 值 。 在 模型 式 (5. 3. 31) 
H, wa) = 0,v G) 一 0 时 ,确定 系统 
x° (t) = f[x" (2),0] (5. 3. 34(a)) 
z" (1) = hix" (可 (S.3.34(b)) 
的 状态 x" GO 和 测量 z* G) 称 为 标 称 状态 和 标 称 测量 量 。 
将 SLX) z] fl h[x(O ,z] E x* G) 附近 展开 成 泰勒 级 数 ,进行 一 阶 截断 ,并 对 
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g[x(t) ,tj] 取 零 次 近似 , 即 g[x(2) , t] ~ g[x" (0) ,t], 可 得 
2a) 一 BAE Bet) telr tlw) (5.3.35(a)) 
20) = Ws tees) +o) (5. 3. 35(b)) 
这 就 是 围绕 标 称 值 的 线性 化 方程 。 式 (5. 3. 35) 中 
X(t) = x() —x* (D) 
z G) = zGt) —z° (t) 
分 别称 为 状态 偏差 和 测量 偏差 。 
类 似 地 ,围绕 估计 值 的 线性 化 方程 为 
ÈO = FEW + g[2(D ,w(t) (5.3. 36(a)) 
z(t) = HSC +o (O 65. 3. 36Cb)) 
式 中 TA) = xG) —£() 


z(t) = zl) —A[£(0O J 
ƏSA] y AE] 
F= a H = Og) 
在 利用 基于 泰勒 级 数 展开 的 方法 进行 模型 线性 化 时 ,特别 需要 注意 的 是 向 量 函 数 
f(x) 对 向 量 x 的 求 导 ,如 果 系 统 模型 比较 复杂 ,那么 这 将 是 一 个 很 繁琐 ,也 很 容易 出 错 
的 计算 过 程 。 关 于 向 量 和 和 矩阵 的 求 导 运算 ,可 以 参考 第 2 章 中 关于 和 矩阵 求 导 的 内 容 。 


5.4 建立 随机 动态 系统 模型 时 需 注意 的 问题 


5.4.1 模型 向 量 的 选取 


对 实际 的 动态 系统 建 模 时 ,首要 的 问题 就 是 模型 向 量 的 选取 。 动 态 系统 模型 中 
的 向 量 主要 是 状态 向 量 和 测量 向 量 。 其 中 , 状态 向 量 是 表示 系统 物理 过 程 运动 学 和 
动力 学 状态 的 变量 ,测量 向 量 是 系统 物理 过 程 中 可 以 外 部 测量 的 变量 。 

模型 精度 与 所 考虑 的 影响 系统 的 因素 有 关 。 显 然 ,考虑 的 因素 越 多 ,模型 也 越 精 
确 ,当然 复杂 度 也 越 高 。 模 型 是 系统 内 部 本 质 信息 的 反映 ,应 该 抓 住 主要 的 本 质 因素 ， 
不 必 考 虑 过 程 所 有 的 因素 。 模 型 向 量 的 选取 是 根据 系统 功能 需要 和 要 求 确定 的 。 

1. 状态 向 量 的 选取 

动态 系统 的 状态 向 量 由 任意 一 组 足以 完全 描述 该 系统 无 扰动 运动 的 量 所 组 成 。 
当 给 出 具体 时 间 点 上 的 状态 向 量 ,以 及 该 时 间 点 后 系统 扰动 函数 与 控制 函数 的 描述 时 ， 
可 以 确定 其 他 任何 时 间 点 上 系统 的 状态 。 对 于 系统 状态 向 量 的 选取 ,应 考虑 以 下 要 求 ， 

(1) 系 统 功能 的 要 求 。 不 同 的 系统 实现 的 功能 不 同 。 对 于 导航 系统 而 言 ,一 般 
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要 求 系统 提供 载体 的 位 置信 息 和 姿态 信息 。 以 舰 船 导航 为 例 ,如 果 把 航船 仅 视 为 一 
个 质点 , 则 仅 要 求 位 置信 息 ,状态 向 量 可 选取 为 
x=[p à Cf 
如 果 把 舰 船 视 为 一 个 刚体 , 则 既 要 求 有 其 质心 的 运动 ,又 要 求 有 绕 质 心 的 运动 ,状态 
向 量 可 取 选 为 
x=[g à C u w Q 
如 果 把 舰 船 视 为 质点 , 且 要 自动 保持 航向 功能 ,状态 向 量 可 选 为 
x=[p à Cv p. w vr of 

在 上 述 各 状态 向 量 中 , p 为 纬度 , 4 为 经 度 , C 为 航向 , v 为 航速 , o 为 纵 摆 角 , 0 
为 模 摆 角 ，w 为 纵向 航速 ，wr 为 模 向 航速 ,v1 为 纵向 加 速度 , v 为 横向 加 速度 。 — 

(2) 系 统 滤波 的 要 求 。 在 实际 的 滤波 问题 中 ,会 有 一 些 运动 参数 及 仪器 系统 误 
差 等 ,为 了 使 滤波 顺利 进行 ,需要 将 它们 扩展 到 状态 向 量 中 ,作为 状态 向 量 的 一 部 分 
而 估计 。 如 

x=[p À uw ve C or 

式 中 , 9 为 纬度 , 4 为 经 度 ，C 为 航向 ,。 为 航速 ，wn 为 海流 北 分 量 , vs 为 海流 东 分 量 。 

〈3) 实 际 运算 的 要 求 。 滤 波 处 理 占用 的 计算 机 时 间 和 状态 向 量 的 维 数 有 关 。 据 
分 析 , 滤 波 占用 的 时 间 与 状态 向 量 维 数 ”的 三 次 方 成 正比 。 占 用 机 时 越 多 ,滤波 
的 实时 性 就 越 差 。 因 此 ,在 满足 功能 要 求 的 情况 下 ,应 尽量 降低 状态 向 量 的 维 数 。 
但 是 随 着 计算 机 速度 的 提高 ,对 舰 船 导航 信息 处 理 系统 来 说 ,该 矛盾 已 不 再 突出 。 

需 注意 的 是 ,状态 向 量 不 是 唯一 的 ,如 选择 的 系统 状态 为 x(z), 则 对 于 任 一 非 奇 
RERE AG, x GO = AG)x(2) 也 满足 关于 状态 向 量 的 要 求 。 

2. 测量 向 量 的 选取 

动态 系统 的 测量 向 量 主要 根据 测量 设备 的 输出 确定 。 测 量 设 备 是 根据 实际 的 
观测 任务 配备 的 ,因此 其 输出 量 是 固定 的 。 

(1) 精 度 和 可 靠 性 要 求 。 测 量 向 量 是 对 实际 系统 的 观测 ,是 系统 滤波 的 依据 , 它 
的 精度 和 可 靠 性 直接 影响 系统 滤波 的 精度 和 可 靠 性 ,是 至 关 重要 的 一 个 要 求 。 

(2) 系 统 能 观测 性 要 求 。 选 择 测量 向 量 ,一 定 要 是 动态 系统 能 观测 的 向 量 ,能 用 
于 对 状态 向 量 进行 估计 ,否则 是 无 用 的 。 

(3) 维 数 要 求 。 一 般 来 说 ,测量 向 量 维 数 必须 小 于 或 等 于 状态 向 量 维 数 。 

从 上 面 的 讨论 可 以 看 出 ,系统 的 本 质 特征 与 建 模 的 目的 密切 相关 。 建 模 的 目的 
不 同 ,系统 的 输入 输出 及 结构 就 不 同 ,本 质 信息 也 不 同 ,模型 自然 也 不 同 。 此 外 , 需 
正确 处 理 好 模型 准确 性 与 实用 性 的 矛盾 ,应 紧 紧 围绕 建 模 的 目的 进行 。 

在 选 定 动态 系统 的 状态 向 量 和 观测 向 量 后 ,假定 根据 系统 的 动力 学 和 运动 学 特 
性 建立 的 状态 方程 为 
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xG) = Ax) + BG(tu(t) 十 GCDw(Ct) (5.4.1) 
式 中 , xG) È n EREHE. AO BO) 和 G(z) 是 建立 方程 过 程 中 产生 的 矩阵 。 其 
中 , AG 是 n 阶 方 阵 。 控 制 输入 uC) 和 系统 干扰 wa) 可 以 不 必 是 nn 维 的 , BO 和 
GG) 也 不 必 是 nn 阶 方 阵 。 
对 于 固定 的 测量 设备 ,可 以 按照 测量 原理 建立 观测 方程 , 即 
z(t) = Hx) + (O (5. 4. 2) 
AP, z(z) 是 m ERWE, H(z) 是 m X n ERMER, o (z) 是 m 维 观测 噪声 。 
在 式 (5.4. 1) 和 式 (5. 4. 2) 中 ,关于 系统 干扰 w(z) 和 观测 噪声 o (2) 的 确定 方法 
将 在 之 后 说 明 。 在 一 般 情况 下 ,比较 实用 的 观测 方程 是 离散 形式 的 , 即 
z(&) = H(k)x(k) + (k) 65. 4. 3) 
实际 上 ,对 于 固定 的 系统 ,其 模型 不 是 唯一 的 。 当 给 定 恰当 的 系统 输入 量 和 输 
出 量 (在 连续 的 情况 下 是 x(to)、w(t) 和 zG) ) 时 ,会 有 许多 不 同 的 AG).BG0.GG) 
MHO), 它们 将 得 到 相同 的 输入 -输出 性 能 。 选 择 了 特定 的 AG) BOGO) 和 
HO), 相当 于 选择 了 一 个 坐标 系 。 它 们 的 选择 会 影响 系统 的 可 控 性 和 可 观 性 。 


5.4.2 状态 变量 的 可 控 性 和 可 观 性 


在 实际 的 系统 模型 中 ,并 不 是 所 有 的 状态 变量 都 具有 可 控 性 。 为 了 寻求 最 优 控 
制 规律 ,需要 研究 控制 系统 中 有 关 的 状态 变量 是 否 可 控 。 此 外 , 为 了 建立 最 优 估计 
的 算法 公式 ,需要 判断 控制 系统 中 有 关 的 状态 变量 是 否 可 以 观测 。 考 虑 到 动态 系统 
模型 的 实用 性 ,建立 的 状态 方程 和 测量 方程 必须 分 别 满足 可 控 性 和 可 观 性 。 控 制 系 
统 的 可 控 性 和 可 观 性 是 针对 系统 模型 中 的 状态 变量 而 言 。 所 以 ,严格 地 说 , 应 称 为 
状态 变量 的 可 控 性 和 可 观测 性 。 

控制 系统 具有 完全 的 状态 可 控 性 ,是 说 在 有 限 的 时 间 区 间 Cost] 内 ,如 果 对 控 
制 系统 施加 分 段 为 常数 U 的 控制 作用 ,系统 中 所 有 的 状态 变量 可 由 初始 值 xG) $ 
化 成 任意 值 Ya ), 即 系统 中 每 一 个 状态 变量 均 可 加 以 控制 ,这 样 的 控制 系统 完全 


可 控 。 
下 面 讨论 系统 完全 可 控 的 条 件 。 给 定 n 阶 定常 线性 动态 系统 如 下 
20) = Ax (t) + Bu C) (5.4.4) 
由 前 面 的 讨论 可 知 , 当 to = 0 时 , 它 的 解 为 
x(t) = ex(0) +Í e uco G. 4.5) 


BEE t= n BË, zC) = 0, 即时 刻 状态 的 值 处 在 状态 空间 的 原点 上 (这 并 不 影 
响 讨 论 可 控 性 判 据 的 普遍 性 ) ,因此 得 


xG) 一 0 一 ez(0) 十 | A Bude 
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即 
x(0) 一 一 | Budr 6.4.6) 


RP, e* 可 以 写 为 
= 
e* = J aA 
= 


代入 式 (5.4. 6), 得 
m= h 
x(0) =— Sas f a,()u()dr 
‘4=0 ° 
令 
f aouo 
最 后 得 
= B. 
x(0) =— 27 ABB, 一 一 [B : AB | A2B 1. į A™™B]| … (5.4.7) 
k n 


Br 
如 果 控 制 系统 具有 完全 的 状态 可 控 性 , 则 当 给 定 任意 的 状态 初始 值 x(0) 时 , 式 
(5. 4. 7) 均 能 成 立 。 由 此 得 可 控 性 判 据 :系统 式 (5. 4. 4) 是 完全 是 可 控 的 , 当 且 仅 当 
可 挖 性 矩阵 的 秩 为 n, 即 
Rank[B ; AB ; A2B ; … į AB] = n (5. 4. 8) 
这 说 明 该 矩阵 的 各 列 元 素 B,AB,…,A"'B 应 该 是 线性 独立 的 。 
如 果 在 有 限 的 时 间 区 间 内 ,根据 对 系统 输出 信号 z(t) 的 观测 可 以 确定 系统 中 每 
一 个 状态 变量 的 初始 值 x(0), 则 称 该 系统 具有 完全 的 状态 可 观测 性 。 在 实际 的 系统 
中 ,往往 无 法 直接 测量 需要 的 状态 变量 。 为 了 确定 和 估计 这 些 状 态 变量 的 数值 , 需 


要 判断 这 些 状态 变量 是 否 具 有 可 观测 性 。 
假设 系统 的 状态 方程 为 式 (5. 4. 4) ,而 观测 方程 为 
z(t) = Hx(D) 6.4.9) 
则 根据 状态 方程 的 解 ， 
a) = Her (0) +H | ee Bu Code (8. 4.10) 


在 已 知 uC) 的 情况 下 , 式 (5. 4. 10) 右 端的 积分 项 已 知 ,可 以 暂 不 考虑 , 即 
z(t) = He*x(0) (5.4.11) 
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= 
已 知 e = Darlt)A: 
k=0 
代 人 式 (5.4. 11) ,得 
= 
z(t) = 2>Ja,GOHA:x (0) 
k=0 


或 写 为 

Z(t) = ao GOHx(0) +a, (t)HAx (0) +a (t)HA™x(0) (5.4.12) 
如 果 该 系统 的 状态 变量 完全 可 观测 , 则 给 定 输出 信号 a), 0h, 由 式 (5. 4. 12) 
应 能 算出 x(0) 的 数值 ,此 时 应 满足 下 列 满 秩 的 条 件 


(5, 4. 13) 





即 式 (5. 4. 13) 矩 阵 的 各 行 元 素 应 该 是 线性 独立 的 。 式 (5. 4. 13) 可 以 等 价 写 为 
Rank[H" ; 4IHT ; (AH? i+ i (AD HT] =n (5.4.14) 


5.4.3 了 噪声 统计 特性 的 确定 


对 于 给 定 的 测量 设备 ,观测 噪声 o (2) 是 确定 的 ,一 般 也 不 随时 间 变 化 。 因 此 ， 
余下 的 问题 是 确定 系统 干扰 WO) 统计 特性 ,也 就 是 系统 噪声 强度 矩阵 Q(t) 的 确定 
问题 。@(z) 选取 好 坏 对 滤波 精度 有 直接 的 影响 ,动态 模型 越 不 精确 , 这 种 影响 就 越 
大 。 Q(z) 选取 的 一 个 基本 原则 是 使 Q(z) 的 大 小 与 动态 模型 的 精度 相 匹配 。 如 果 
QG) 选取 过 大 , 则 使 滤波 在 过 去 观测 量 上 的 加 权 衰减 过 快 ,从 而 使 滤波 不 能 很 好 地 
利用 已 有 观测 量 的 信息 ,此 时 的 后 果 是 降低 滤波 的 精度 ;反之 ,如 果 QC) 选取 过 小 ， 
使 滤波 在 过 去 观测 量 上 的 加 权 训 减 过 慢 , 随 着 滤波 的 递 推 ,将 会 引发 越 来 越 大 的 模 
型 噪声 ,从 而 使 滤波 误差 越 来 越 大 ,造成 滤波 发 散 。 

关于 Q(z) 的 选取 方法 ,对 通常 的 动态 系统 ,如 无 机 动 目标 的 跟踪 ,可 取 Q(z) 为 
WEO, 而 Q 值 通 过 事先 的 模拟 计算 确定 。 当 采用 模拟 观测 量 进行 计算 时 ,主要 考 
察 滤波 误差 序列 ,开始 如 Q 选取 过 小 , 则 滤波 误差 序列 将 发 散 ; Q 增 大 到 某 个 值 @* ， 
滤波 误差 的 趋势 将 在 某 一 稳 态 值 附近 摆动 ,此 时 有 最 小 的 稳 态 误差 ; 若 Q 超过 Q* ， 
滤波 误差 的 趋势 仍 在 某 一 稳 态 值 附 近 摆动 ,但 稳 态 误差 将 随 Q 增 大 ,因此 Q 较 好 的 
取 值 应 该 稍 大 于 Q" 。 当 用 实测 观测 量 进行 计算 时 ,主要 考察 预报 残 差 序列 。 对 有 些 
情况 , Q(z) 取 常 值 未 必 恰当 ,应 该 是 随时 间 变 化 的 ,这 应 根据 具体 问题 而 定 。 例 如 ， 
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对 于 带 模型 噪声 的 二 阶 多 项 式 的 动态 模型 ,可 取 QG) = CEV , 其 中 为 可 调 参数 ， 
之 则 通过 其 他 方法 估计 。 对 于 动态 模型 可 能 随时 间 发 生变 化 的 情况 ,如 机 动 目标 跟 
踪 , 应 采用 自 适应 滤波 ,关于 这 方面 内 容 的 论述 请 参见 第 10 章 。 
思 考题 
5-1 设 {BC2),t € T) 为 马尔 可 夫 过 程 ,标量 过 程 (=G) 满足 下 列 随机 微分 方程 
dælt) = A(t)costds + sintd8(r) 


试 求 z(z) 的 方差 函数 。 
5-2 随机 过 程 {y(z) ,之 0) 满足 方程 


DO y = z(t 0,y(0) = 2 
RH, z(D 为 有 色 平稳 噪声 ELz(z)] = 0,Cov[z(O,zG+)] = et! 试 求 : 
D E[y(2)] ; 
(2) CovLz(n), y(t)] ,ht >03; 
(3) Cov[y(n),y(n)]J,n 5 > 0, 
5-3 设 随 机 过 程 (10) ,t > 0) 满足 下 列 微分 方程 
0 1 0 
dz(D) = Ë a a+ [Jeo 
其 中 , AO 为 马尔 可 夫 过 程 。 假 设 初始 状态 为 高 斯 随机 变量 ,满足 


0 1 0 
= ~ NG Ps), 2 = [J -[ ] 


设 采 样 周期 为 0. N n a 
54 一 动态 系统 为 
EEA 
求 此 系统 的 基本 解 BCz) 及 初始 值 为 
ESE 
时 的 方程 解 zGO , 


5-5 已 知 控制 系统 的 状态 方程 为 
1( Fz 
ol [se ol 
POR zi G) H z; G) , 
56 已 知 控制 系统 的 状态 方程 为 


A (ey 1 nlt)] [fz (OY 20] 
思 ( 人 | 一 |0 2 1 Rol, zo|- Ë 
FXO) 0 3(2) Lz(o). | 


POR z G) .ze (2) fl z; (O , 
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57 已 知 控制 系统 的 状态 方程 为 
aol Le lob [eles] U 


假定 


HOR z: G) 和 zz () , 
5-8 确定 cr cr. 和 ho 的 值 ,使 动态 系统 为 可 观 和 可 控 系 统 : 


ESPE IES [Ye 
ot [ES] 
5-9 判断 如 下 的 系统 是 否 为 可 观 可 控 系 统 。 


oti oo 
z(D) = [o [2 ] 


za (t) 
5-10 已 知 系统 的 状态 方程 和 观测 方程 为 


0 1 0 
ż=| 0 0 1 |z 十 |0jz 
一 al 一 az 一 as 


z=[a c c]z 
试 求 !(1) 该 系统 的 状态 转移 矩阵 ; 
(2) z 5 u 之 间 的 传递 函数 ， 
OMR oa = 1,c = co = 0, 则 此 系统 对 于 所 有 的 a) .as 和 a, 来 说 是 否 完全 可 控 和 可 观测 ? 
5-11 一 维 线性 系统 动态 模型 如 下 
Zz(k+1) = az (k) + &&),z(0) = 0 
其 中 ， 
ELz(k)J]= 0,VarLz(h)J= # ECCh) I= 0 
ETRA) J= 0,ELER)ED) J= à, 
证 明 : 对 于 所 有 的 整数 j, 都 有 = p/a) R Erkak +j] a, 
5-12 ”假设 一 维 线性 系统 如 下 
工人 十 1) = zQ) 
Ck) = zk) + KE) 
另外 , EC) J= 0,VarL Xk) = P ,E[z(0) J= 0,Var[z(0)1= ,2 
WH: 


=G s yta lai 
E (ER 一 1 lk 了 十 但 Ca 一 2 一 114 一 D] 


20 |0) =0 
C2) k — co BÍ, 2C | k) — c, c HR 


第 6 章 ”线性 离散 系统 卡尔 曼 滤波 


内 容 提要 本 章 重 点 讨论 线性 离散 系统 的 卡尔 曼 滤 波 器 原理 ,滤波 公式 、 定 性 
理论 及 应 用 。 首 先 在 系统 不 含 控制 项 噪声 为 白色 不 相关 过 程 的 情况 下 分 别 通 过 直 
观 法 和 投影 法 推导 出 卡尔 曼 滤 波 公式 ,并 在 系统 含 控 制 项 噪声 为 相关 过 程 及 骂 声 
为 有 色 过 程 的 情况 下 进行 推广 ;其 次 讨论 卡尔 曼 滤 波 器 的 稳定 性 和 健壮 性 ;然后 介 
绍 线性 离散 卡尔 受 的 最 优 预 测 和 最 优 乎 滑 问 题 ; 最 后 结合 舰 船 横 摇 运动 和 全 浸 式 水 
村 艇 的 姿态 最 优 估计 问题 ,介绍 线性 离散 卡尔 曼 滤波 的 具体 应 用 。 


6.1 引 É 


35 4 章 介绍 了 维 纳 滤波 ,这 是 随机 控制 领域 的 一 个 重要 研究 成 果 , 它 给 出 了 线 
性 随机 系统 状态 在 最 小 方差 意义 上 的 最 优 估计 。 但 这 种 理论 存在 以 下 局 限 :@ 它 
要 求 随机 过 程 都 是 平稳 的 ,这 在 实际 系统 中 未 必 满 足 !@ 维 纳 滤波 公式 是 通过 平 
稳 过 程 的 谱 分 解 导 出 的 ,难以 推广 到 较 一 般 的 非 平 稳 过 程 和 高 维 情形 ;@@ 维 纳 - 夫 
夫 积 分 方程 在 通常 情况 下 很 难 求解 ,即使 求 出 了 最 优 滤波 器 的 脉冲 过 渡 函 数 ,在 
工程 上 往往 也 很 难 实现 ;@@ 维 纳 滤波 是 批 处 理 方法 ,不 能 满足 在 线 快 速 处 理 大量 
数据 的 需要 。 . 

20 世纪 50 年 代 中 期 , 随 着 空间 技术 的 发 展 ,大 量 的 高 维 、 非 线性 、 非 平稳 随机 过 
程 的 估计 问题 出 现 了 ,对 状态 估计 技术 提出 了 更 高 的 要 求 , 维 纳 滤波 已 无 法 满足 需 
要 。 在 这 种 情况 下 ,1960 年 , 美 籍 匈牙利 数学 家 卡尔 曼 (Kalman) 将 状态 空间 分 析 方 
法 引信 到 滤波 理论 中 ,对 状态 和 噪声 进行 了 完美 的 统一 描述 ,得 到 时 域 上 的 递 推 滤 
波 算法 , 即 卡尔 曼 滤波 ,相应 的 算法 公式 称 为 卡尔 曼 滤波 器 。 

卡尔 曼 滤波 是 在 已 知 系统 和 量 测 的 数学 模型 . 量 测 噪声 统计 特性 及 系统 状态 初 
值 的 情况 下 ,利用 输出 信号 的 量 测 数 据 和 系统 模型 方程 ,实时 获得 系统 状态 变量 和 
输入 信号 的 最 优 估计 值 。 它 是 一 种 线性 ,无 偏 , 且 误差 方差 最 小 的 随机 系统 最 优 估 
计算 法 。 与 维 纳 滤波 相 比 ,卡尔 曼 滤波 不 仅 适用 于 非 平稳 随机 过 程 ,而 且 可 以 递 推 
实现 。 因 此 ,对 于 计算 机 运算 ,卡尔 曼 滤波 的 运算 量 和 存储 量 大 为 减少 ,容易 满足 实 
时 的 要 求 ,在 工程 实践 中 迅速 得 到 了 广泛 的 应 用 。 

在 这 一 部 分 中 ,首先 基于 离散 系统 模型 推导 卡尔 曼 滤波 公式 。 选 择 从 离散 时 间 
形式 开始 研究 卡尔 曼 滤波 是 比较 适宜 的 。 首 先 , 从 研究 历史 上 看 ,卡尔 曼 就 是 在 
1960 年 首先 解决 了 离散 时 间 形式 的 卡尔 曼 滤波 问题 ,到 1961 年 他 才 和 布 西 (Bucy) 
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一 起 研究 连续 时 间 的 情况 。 其 次 ,离散 模型 在 数学 上 有 其 特有 的 优点 ,便于 计算 机 
处 理 , 而 且 某 些 特性 的 证 明 比 连续 形式 更 容易 。 


6.2 线性 离散 系统 卡尔 曼 滤 波 器 的 推导 


下 面 介 绍 两 种 线性 离散 系统 卡尔 曼 滤波 器 的 推导 方法 :直观 法 和 投影 法 。 
6.2.1 直观 法 


假设 线性 离散 系统 模型 如 下 
x, = DeX + Th We (6.2.1(a)) 
z= Hix, + (6. 2. 1(b)) 


式 中 ,过 程 噪声 w 和 观测 噪声 w 的 统计 特性 为 
Elw J= 0,Ro (ksj) = Q, 
E[vw]= 0,R, (ksj) = Ry 
R..(k,j) = 0 
初始 状态 xo 的 统计 特性 为 
E[xo] = xo, Var(xo) = P, 
假定 xo 与 w 和 wi 均 无 关 , 即 
Ra (0,k) = ECxom,)" = 0 
Ra (0,k) = E(xo0)T = 0 
假设 在 & 时 刻 已 经 获得 & 次 测量 值 zi,za，……zeivzk， 并 且 得 到 x, 的 最 优 线性 
估计 ria CEP ri 是 Zi 9，Z2 (| Z) 的 线性 函数 ) ,由 于 wii 是 零 均值 的 白 噪 声 ， 
所 以 直观 法 是 以 如 下 形式 
i = Di (6. 2. 2) 
作为 ei 的 预测 估计 。 由 于 o, 是 零 均值 的 白 噪 声 ,所 以 对 时 刻 系统 测量 值 z 的 
预测 估计 为 


Ci = He (6. 2. 3) 
在 得 到 & 时 刻 测 量 值 ze 后 ,可 计算 出 它 与 预测 估计 之 差 , 即 
Ziea = Zh itt = a — Hiha (6. 2. 4) 


产生 这 一 偏差 的 原因 是 :预测 估计 与 测量 值 < 都 可 能 有 偏差 。 为 了 得 到 时 刻 状态 
= 的 滤波 值 , 自然 想到 可 以 用 预测 偏差 Zu: 修正 状态 预测 估计 $i, BI 





$, = Bi +K,[z, — Ht] (6. 2. 5) 
式 中 , K, 为 待定 的 增益 矩阵 。 以 下 的 问题 是 如 何 按照 目标 函数 
J = ELit] (6.2. 6) 


最 小 的 要 求 确定 最 优 滤波 增益 矩阵 。 
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定义 


Eia = X, — Š 
Xa, Xk — $ 
它们 分 别 表示 获得 测量 值 z, 之 前 和 之 后 对 xx 的 估计 误差 。 
利用 上 述 定义 及 式 (6. 2. 5 有 
Xa = Xa — Îr 
= Xam —K,[H,x, + — H,#u1] 
= Zam KH: am +w] 
一 [I—KH,]x,,— — Ko (6.2.7) 
从 而 
EZ th= ([I—KH,]xu, — K, v ) (z1  [I—KH,Jt —sIKI) 
= [I— KH JX tim UKH: ]" — Ker ha [Ll — KH] 
—[I—K.H,]x, VK] + K,o;oIKT (6.2.8) 
由 于 Z, 是 和 ,zs，…zea 的 线性 函数 , 且 测量 误差 是 不 相关 的 ,所 以 根据 向 量 投影 


MRR E[xue 三 ] = 0, Elain] = 0 
于 是 ,滤波 误差 协 方差 矩阵 为 
Pin = Elti] = UKH, JPI KH] +K.R,KË. (6. 2, 9) 
AP, Paea = E[ zu Yh ]。 
下 面 确定 增益 矩阵 K, , 选择 K, 的 原则 是 使 误差 协 方差 矩阵 Pa 对 角 元 素 的 加 
权 标量 和 最 小 , 即 选择 代价 函数 








J, = tr(P,,) 
这 等 价 于 使 估计 误差 向 量 的 长 度 最 短 。 为 了 求 得 使 J 最 小 的 K; 值 , 只 需 将 J, XF K, 
的 偏 导数 为 0。 可 求 得 
K, = P, i HI (HiPuiHE HR)’ (6.2. 10) 
上 述 求 偏 导 过 程 中 需要 利用 公式 


ALABAT] = 24B 
此 时 ,误差 协 方差 矩阵 为 
P,.,= Para —P,,—iHI(H,Pu, i HI +R) HP r 
=[I—K.H,]P,,, (6.2.11) 
这 样 ,估计 误差 协 方差 矩阵 Pus 具有 式 (6. 2. 9) 和 式 (6. 2. 11) 两 种 不 同 表达 的 形式 。 
下 面 计算 预测 误差 协 方差 矩阵 Pei 。 为 此 , 先 计算 预测 误差 
Fia x; — hall 
= rX + Tw — Ori fea 
= Fe + Te we (6. 2. 12) 
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因此 有 


Yu Che = [Or Fee +T, Wea [Be Te + Th we 


T T T g 
= Bo Xi Fha Dha + Ti Wea Fiai Dia 


Heim Wei WaT t+ Be YewhThe (6. 2. 13) 
由 于 
E[@B Tm wm] = 0 
ELT: uwa hu Bh | = 0 
于 是 有 


Piri = ELO, Xu The we LD Fee + Th we 
= Dra Prima Dha +T, QT (6. 2. 14) 
至 此 ,离散 卡尔 曼 滤波 器 所 有 公式 的 推导 完成 了 ,将 它们 集中 在 表 6. 1 h. Bl 
6.1 是 离散 系统 结构 图 ,图 6. 2 为 卡尔 曼 滤波 器 的 结构 图 。 


表 6.1 离散 卡尔 曼 滤 波 器 方程 一 览 表 

















系统 模型 x = ri Xim + Th Wi w ~ N(0,Q@.) 

测量 模型 w= Hizi +o — NO0,R,) 

初始 条 件 Ex(0)] = $o, E[ (x(0) — $o) (X(0) — $o)T] = Po 
其 他 规定 E[wwv F] = 0 (对 所 有 的 j,k) 

状态 预测 | $i = Dh 

误差 协 方差 预测 Pi = Or Praia OE + TQ Th 
状态 估计 校正 Blk = aa +K.[z, — Hifa ] 

误差 协 方差 估计 校正 P. —KH,JP,-i 

卡尔 曼 增益 K, = Pa HF [HP HE HRI 








6.2 离散 卡尔 曼 滤波 器 


由 于 卡尔 曼 滤波 是 一 种 递 推 滤波 ,需要 考虑 如 何 确定 初 值 名 KIRE Po. 2o 可 
以 赁 经 验 给 出 ,但 P, 无 法 直接 获得 ,只 能 由 初始 的 若干 测量 经 统计 方法 得 到 。 不 过 ， 
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只 要 滤波 是 稳定 的 ,或 者 说 只 要 式 (6. 2. 1) 满 足 一 定 的 条 件 ,那么 递 推 滤波 将 不 依赖 
名 fü P, 的 选取 。 关 于 滤波 的 稳定 性 问题 ,将 在 后 面 详细 介绍 。 
由 卡尔 曼 滤波 公式 可 知 ,卡尔 曼 滤波 在 进行 滤波 估计 的 同时 还 产生 了 估计 误差 
方差 阵 Pu， 它 用 于 计算 估计 精度 , 即 滤波 器 在 进行 估计 的 同时 还 给 出 了 误差 分 析 。 
在 线性 离散 卡尔 曼 滤波 器 中 ,计算 协 方差 的 目的 主要 是 为 了 求 出 K, 然后 利用 
K, 计算 估计 值 Zuk。 从 状态 方程 到 协 方差 方程 没有 反馈 。 
增益 矩阵 K, 还 有 另 一 种 简单 的 表达 形式 。 利 用 和 矩阵 求 着 公式 ,对 于 式 (6. 2. 13) 
中 的 Pu 和 Pui， 可 表示 为 
Pi = Piim + HIR;'H, (6. 2. 15) 
其 实 , 只 需 注意 到 P. P; = I, 即 可 证 明 式 (6. 2. 15) 。 利 用 此 结果 ,可 以 将 K, 化 为 
如 下 形式 
K,= [Pu,P;h Pam HECH Pam HI +R, J: 
= P, [ P, + HER H, JP, i HI[H,P,, HF + RT 
将 上 式 展开 并 化 简 , 得 
K,= P,i#Hi[ I+ R;'H,Pu: i HI J[H,P,, HE + RJ] 
= Piu HRY (6. 2. 16) 


6.2.2 投影 法 推导 


卡尔 曼 滤波 的 直观 推导 法 正确 反映 了 滤波 的 物理 过 程 ,对 于 工程 应 用 已 经 足够 
了 。 但 是 ,直观 推导 法 在 数学 上 不 够 严密 ,考虑 到 投影 法 在 数学 上 的 严密 性 ,有 必要 
讨论 用 投影 法 推导 卡尔 曼 滤 波 器 。 

系统 的 数学 模型 和 噪声 统计 特性 见 式 (6. 2. 1) — (6. 2. 4) ,用 投影 法 推导 卡尔 曼 
滤波 器 按 如 下 步骤 进行 。 

(1) 确 定 最 优 线 性 预报 估计 。 

根据 2. 5 节 中 投影 理论 的 结论 1, 设 基于 & 一 1 次 测量 向 量 集合 对 : = [zi， 
2 zt] 的 线性 最 小 方差 估计 为 





$w = ELxe | zt] (6. 2. 17) 
那么 ,基于 zf 估计 x 的 一 步 最 优 线性 预报 为 
fum = ELxs | zt (6.2.18) 


而 由 式 (6. 2. 18) 和 第 2 章 中 正 交 投 影 理 论 的 结论 2 得 
fum = EDsxe Henw | 821) 
= Bexe +T. ÊW |A (6. 2. 19) 
由 于 假设 wi 与 五 ,za，…zri 不 相关 , 即 wi 5 zi EROAA zi 5 wea 
不 相关 的 加 ,Ww ，… Wiz yw , 世 ，…pral 线 性 表示 ), 且 有 下 (wei) = 0, 故 由 正 交 投 影 
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理论 的 结论 1 可 知 Ewa | zf) 一 0。 因 此 , 式 (6. 2. 19) 化 为 


站 = 加 (6. 2. 20) 
记 Xu = x, — us, M Paa 85 z! 正 交 。 
〈2) 确 定 最 优 线性 预报 测量 值 。 


基于 对 : 对 z 所 作 的 一 步 最 优 线性 预报 应 该 为 
am = ÊC | zt) = ËCH,x, +, | x!) 


= B,ÉG | zf!) + ÊC, | zf!) (6. 2. 21) 
HFa j xe W W00 u PRB a 55 zt 正 交 , 且 有 Elw) = 0, 于 是 
iea = Hifa = HOr emim (6. 2. 22) 
ORME z, 与 z 生 的 正 交 分 量 新 息 序列 。 
由 于 和 ci A z E 上 的 投影 ,因此 
Ziea = l bi = =, — HD Re (6.2. 23) 


H zr ER. a WA k KWE zx 的 预测 残 差 ,也 称 为 新 息 序列 。 它 表示 从 第 
次 测量 量 =* 中 减 去 前 4 一 1 次 测量 量 中 所 包含 的 关于 z, 的 “ 旧 ” 信 息 2a 。 
(4) 确 定 a 的 递 推 公式 。 
根据 正 交 投 影 理论 的 结论 4 得 
$ = ÈC | zt) 
= Êl | zF!) HEC | Zama) 
= Em | zF!) H (Eg, Th) (EZ aea Zia) Zaa (6. 2, 24) 
Ho i 正 交 可 知 , v 与 Yin 不 相关 ,于 是 有 
Elnia Tiemi) = Ela (Hama +) ] 
= P, Hí 
E(Zu— Zhe) = E[z, — Hfr Jir — Hea ]™ 
= E[H, £ am +u JLH, am +u Jt 
= H,P,, HÍ +R, 
再 结合 式 (6. 2. 18) ` 式 (6. 2. 20) 和 式 (6. 2. 23) 一 式 (6. 2. 24) 化 为 
$= ÊC | zt) 
= Bb T Pur i HI (H,P,—i HI + R, [zs — Drem] 
上 式 中 , 令 
K, = P, HT (H,P,, HE + R,) ` (5.2.25) 
则 滤波 递 推 公式 最 后 可 表示 为 
$a = ÊC | z) 
= Bde +K[z, — H,@,, mm] (6.2.26) 
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5) 确定 滤波 误差 方差 阵 递 推 公式 。 
由 


Til x, — Cate 
= Dra (xi — Cee) + Tr Wea 
= Ba Te Tea Wei 


得 
Para = E(Xuri Yh) 


= Ef Orei Xi + Tow JO Tey + Twe]T 
由 于 xi 与 w- 不 相关 , 且 EC(wrwL) = Q... FE 
Para = Dera Pri Diei +T, QT (6. 2. 27) 
由 


了 一 x, — u 
= xa — fim — Kalz — Ht] 
= Yaa — KUH, am +w] 
= [I— KH: ] Zam — Kor 


Pin = Elut) N 
= E[(IT—KH) Xu ~K JL (I—K,H,)X,—1 一 了 me]T 
= U- KH, Pam U — KH, ]"+KRK] (6. 2. 28) 
采用 与 6. 2. 1 小 节 同 样 的 方法 ,可 以 将 式 (6. 2. 28) 化 简 为 
Pin = [I — KH, Pye (6. 2. 29) 

可 见 ,用 投影 法 推导 的 卡尔 曼 滤波 公式 与 用 直观 法 推导 的 公式 完全 一 致 。 

由 线性 离散 系统 的 卡尔 曼 滤波 器 公式 可 以 得 出 以 下 结论 : 

(1) 卡尔 曼 滤波 器 具有 递 推 的 性 质 。 如 果 已 知 第 一 1 步 的 估计 值 ,根据 系统 的 
状态 方程 和 第 & 步 的 测量 方程 就 可 以 计算 出 第 & 步 状态 x; 的 最 优 线性 滤波 £6。 E 
此 ,在 滤波 之 前 需要 已 知 初始 估计 值 。 

(2) 在 滤波 方程 

fi = iea HK lz — Hifa ] 
P, 名 lc 是 $a 的 一 个 初步 估计 , 即 根据 一 1 步 的 估计 和 状态 方程 ,作出 一 步 最 优 
预报 。z — Hifa 表示 第 & 次 测量 与 其 预报 值 之 差 , 称 Zia = la — Hasa 为 第 
次 测量 后 的 新 息 。 如 果 Zami = 0, 则 此 次 测量 未 带 来 任何 新 的 信息 ,xx 的 最 优 估计 
如 ke 就 是 一 步 预 报 估计 fai 。 

(3) 由 滤波 方程 可 知 ,最 优 线 性 滤波 是 不 断 地 通过 反馈 校正 而 形成 的 , KZ， 
是 与 第 次 测量 新 息 成 比例 的 校正 项 ,比例 矩阵 就 是 增益 矩阵 Ko 

(4) 由 

K, = Pu H: (H.P, HE +R) 
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可 知 ,增益 矩阵 与 Pu REEMS R 成 反比 。 这 一 点 很 容易 理解 。 如 果 一 步 预 
报 如 ci 很 准确 , 即 预报 误差 方差 阵 Parm 很 小 ,那么 用 测量 新 息 Tam 修正 预报 值 的 
意义 就 不 大 ,因此 新 息 的 加 权 即 增益 矩阵 也 很 小 。 对 于 极端 的 情况 , P,, 二 0, BJ 
$i 就 是 xz 的 准确 值 ,自然 有 K, = 0。 如 果 测 量 z, 很 准确 , 即 测量 误差 方差 R 很 
小 , 则 测量 新 息 很 重要 ,那么 增益 矩阵 就 应 该 大 些 ; 如 果 测 量 误差 大 ,就 应 重视 原 有 
的 估计 ,增益 矩阵 就 很 小 。 

(5) 从 公式 

Paii = Dra P, ui Diem tT iQ a IL 

可 知 , Pumi 与 Cr-; 成 正比 。 可 以 这 样 理 解 ,系统 的 于 扰 w- 越 强 , 即 Q, 越 大 ,就 应 
该 更 重视 测量 ,增益 矩阵 也 就 越 大 。 

将 卡尔 曼 滤 波 与 之 前 的 最 小 二 乘 估计 方法 和 维 纳 滤波 相 比 ,有 

D 最 小 二 乘 估计 法 可 行 的 条 件 是 只 需要 系统 的 测量 方程 和 测量 误差 方差 的 信 
息 , 而 卡尔 曼 滤波 可 行 的 条 件 是 不 仅 需要 系统 的 测量 方程 ,还 需要 系统 的 状态 方程 
及 系统 干扰 和 测量 误差 的 均值 和 方差 信息 ;最 小 二 乘 估计 法 和 卡尔 曼 滤波 器 都 能 在 
得 到 系统 最 优 状态 估计 值 的 同时 ,还 得 到 估计 误差 的 方差 。 

(2) 维 纳 滤波 要 求 系统 的 输入 是 平稳 过 程 ,而 卡尔 曼 滤波 对 系统 的 输入 没有 要 
求 ; 维 纳 滤波 需要 知道 系统 的 输入 和 噪声 的 功率 谱 密度 ,以 及 输入 和 噪声 的 互 谱 密 
度 ,而 卡尔 曼 滤波 需要 已 知 系统 干扰 和 测量 误差 的 均值 和 方差 信息 ; 维 纳 滤波 属于 
批 处 理 方法 , 而 卡尔 曼 滤波 是 递 推 方法 ,可 以 实时 实现 ; 维 纳 滤 波 器 的 解 是 最 优 滤波 
器 的 传递 函数 或 是 冲 激 响应 ,而 卡尔 曼 滤波 器 的 解 是 系统 的 最 优 状态 。 

下 面 用 具体 的 例子 说 明 如 何 应 用 离散 系统 的 卡尔 曼 滤波 器 。 

例 6.1 EA zk) 的 AR(2) 模 型 


a) =—3z(k—l) -alk 2) + 2w), k> 0 


E E[w(k)w(j)] 二 6(j 一 k)。 假 设 环境 噪声 v(k) 为 加 性 白 噪声 , 且 E[v(k)w(j)] = 
8G 一 上 。 利 用 卡尔 曼 滤 波 器 估计 标量 信号 zx(&) 。 
解 ” 估 计 信 号 为 标量 信号 ,需要 建立 其 状态 模型 和 观测 模型 ,可 以 利用 模型 中 

的 两 个 时 间 延 迟 建立 (也 可 以 采用 其 他 的 方法 建立 状态 方程 , 这 将 给 出 不 同 的 滤波 
形式 ,但 滤波 结果 是 一 致 的 ) 。 定 义 状态 变量 如 下 

Z1(k) = x(k) 

x(k) = z(k— 1) 
根据 z, Ck) 和 z; CK) 的 定义 ,可 将 C) 的 AR(2) 模 型 改写 为 

mG) = n A) Er H wk HD 


z (k + 1) = z (k) 


第 6 章 线性 离散 系统 卡尔 曼 滤 波 "137， 





将 上 述 两 个 方程 用 矩阵 的 形式 写 为 
3 _1 
x1(k 二 1) => — 5 |z (k) z 
= 4 2 
Earn] | Pa ESH [Jetty (6. 2. 30) 


H ok) 为 加 性 噪声 可 知 ，z( 十 1) = zk 十 1) 十 vl 十 1), 所 以 观测 模型 可 
以 写 为 
Zi(R 十 1) 


k+1 6. 2. 31 
rph™ +l Ç 31) 


zk+D=[1 0] [ 
在 标准 模型 式 (6. 2. 30) 及 式 (6. 2. 31) 中 ， 


o= K - 引 r- 四 aa J 


已 知 , Q = 1,R = 1。 再 取 初 始 值 
zx1(0) 0 10 0 
[o] [ro Z: B 10] 
其 中 ,状态 估计 的 初始 值 取 为 零 矢 量 , 因为 所 处 理 信号 是 由 零 均 值 的 白色 信和 号 源 产 
生 。 初 始 的 方差 矩阵 是 任意 选取 的 。 
在 上 述 条 件 下 ,利用 离散 的 卡尔 曼 滤波 公式 可 得 P(E 十 1 | D.KG + D), 
P(k&+1) 和 (十 1) 的 计算 公式 如 下 ， 


[ |Ë) peGk+1| »] 
palk +1|k) p2(k+1 |k) 


3 1 1 


3 
— —s|[ bu) p(k) 4 2 
s i [ 
| i o | bak) d 1 +[ohrz 0] (6.2.32(a)) 


Ka CR 十 1)] Fpnlgt+l|k) pu(k+1 |k) 
[kato] L] 


Ks(R 十 1)J Lpn(k+11k) palk+t+l|k)JLo 


Pulk+1 |k) pu(k+1 |k) Ba 
xfi 91 Tore ea 
a pulk +1 |k)/[1+ pulk +1 | DJ 
u apa [E)/[1+ pa +1] BI 
os anjil aro] pa abd] 
加 (十 ID) pulk+l) 0 1] LK(k+D) Pak) px (h) 
opa ses 0 4 piz (k) 
—K;(k+1) il Pn(k) pa(k) 





(6.2. 32(b)) 


] (6.2. 32(c)) 
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3 3 f 1,1 
二 十 羡 Ki 十 1) 一 到 十 豆 及 (十 1 


[° e+p] jè 四] 
BAED- | itk a+D lgarn |2% 
Ki(k+1) 
[ea tt? (6.2. 32(d)) 
在 给 出 & 十 1 个 观测 值 以 后 ,可 以 用 离散 卡尔 曼 滤波 器 递 推 地 计算 z( 的 估计 什 
kG +D. 


例 6.2 已 知 离散 型 线性 系统 的 状态 方程 和 观测 方程 如 下 
z (k + 1) = 2z, (k) + z+ (k) +w) 
a (k+1) =— zi (k) + 2x2 (&) 
z(k) = za (k) + vk) 


oo] [Ja =Ü eos Jem: 
试 求 卡 尔 曼 滤波 估 值 21 (1). 2, 1) 和 滤波 误差 方差 阵 。 
解 由 给 定 的 模型 可 知 


o-[ °, 中 = 1) 


并 已 知 


Eo L s| mr atremta 
ae-[ ERE] ezsscy) 
Pazeni alo ls P d- Es a] 
(6.2. 33(b)) 


Ki= PioHILH P. H] +R, J” 
-区 ie VEH- eo 
Z =z — Hw =0.5—[0 1] [ ,|= 


à = iw tKa —Mminl=[ ot#[ |a =[ 20 1 














(6. 2. 33(e)) 
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peire ET | os 


14 —2/3 
= sa 
Ë 2/3 8/9 ] (6. 2. 33(f)) 











62.3 卡尔 曼 滤 波 器 的 直观 解释 


卡尔 曼 滤波 的 基本 思想 与 舰 船 组 合 导航 人 员 作业 中 对 船 位 推算 的 逻辑 思维 方法 
是 相 吻合 的 。 在 海 图 作业 中 ,航海 长 通常 以 前 一 时 刻 的 舰 位 为 基准 ,根据 航向 ,航速 和 
海流 要 素 等 推算 得 下 一 个 船 位 。 这 时 他 并 不 轻易 认为 船 位 就 一 定 在 推算 船 位 处 ,还 要 
选择 适当 的 方法 ,通过 仪器 得 到 另 一 个 推算 船 位 。 观 测 和 推算 两 个 船 位 一 般 不 重合 , 航 
海 长 需要 通过 分 析 和 判断 选择 一 个 最 可 靠 的 船 位 ,作为 舰 船 目前 的 位 置 。 

卡尔 曼 滤 波 的 基本 思想 也 是 这 样 ; 它 以 一 1 时 刻 的 最 优 估计 3%Ck 一 1 1 一 1) 为 
准 ,依据 导航 系统 的 状态 方程 ,预测 时 刻 的 状态 向 量 *Ck | & 一 1), 同时 又 对 状态 进 
行 观测 ,得 到 观测 向 量 z(2) , 青 在 预测 与 观测 之 间 进行 分 析 ,或 者 说 以 观测 量 对 预测 
值 进行 修正 ,从 而 得 到 时 刻 最 优 状态 估计 Ck | D, 

两 者 都 是 通过 分 析 判 别 所 得 ,前 者 是 依靠 人 工 定性 分 析 , 而 后 者 是 依靠 数学 方法 
由 计算 机 自动 进行 定量 分 析 的 过 程 。 两 者 的 基本 思想 都 可 归结 为 “预测 "和 “修正 ”。 

假设 导航 系统 模型 表示 为 

Ce = @(,k—1)x(& —1) +w(k—1) 
z(&) = H(&)x(&) +o Ck) 
为 简化 问题 ,模型 中 的 状态 向 量 和 量 测 向 量 均 为 二 维 ( 经 度 和 纬度 ) , 即 


“w= [tw] -eal 
BRENER HGD = 1, 


由 于 该 系统 的 状态 为 一 个 点 ( 船 位 ) ,因此 ,卡尔 曼 滤波 运行 过 程 可 以 用 平面 点 
位 图 表示 ,图 6. 3 为 一 1 时刻 至 十 2 时 刻 的 工作 过 程 示意 图 。 





(k2) 


A 
(k-1) (k) 
OHR k 估计 船 位 ”入 测量 船 位 
图 6.3 航海 中 海 图 作业 的 示意 图 
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对 图 6. 3 中 的 符号 说 明 如 下 : 

D 符号 让 代表 经 过 Kalman 滤波 估计 得 到 的 最 优 估计 船 位 ,A 为 一 1 时刻 最 
佳 估计 船 位 均一 1 | £ —1), DAAG 点 类 同 ; 

(2) 符号 人 代表 由 Kalman 滤波 得 到 的 预测 船 位 ,B 点 为 由 A 点 经 过 状态 转移 
得 到 的 & 时 刻 的 预测 船 位 人 (| k — 1), E AMH 点 类 同 ; 

(3) 符号 A 代 表 量 测 船 位 ,C 点 为 & 时 刻 量 测 船 位 zC&) ,下 点 为 十 1 时 刻 量 测 
船 位 =<( 十 1) ; 

《4) BC 线段 代表 时 刻 从 量 测 中 获得 的 新 息 sC&) = zk) 一 &(k | k—1) ; 

(5) BD 线段 代表 & 时刻 增益 矩阵 与 新 息 的 乘积 KC&)eCk), 即 对 预测 船 位 的 
修正 量 。 

卡尔 曼 滤波 的 过 程 是 :每 隔 一 个 滤波 周期 ,通过 量 测 传感器 得 到 量 测 船 位 C, 同 
时 经 过 状态 转移 得 到 预测 船 位 B, 在 量 测 船 位 和 预测 船 位 之 间 根 据 增益 K(k) 进行 
折 中 ,从 而 获得 最 佳 估计 船 位 D, 依 此 过 程 不 断 循环 下 去 。 

对 卡尔 曼 滤波 和 航海 图 作 如 下 分 析 : 

D 如 果 不 存 在 系统 干扰 W), 也 不 存在 量 测 噪声 o G) ,根据 卡尔 曼 滤波 的 
假设 条 件 , 系 统 干扰 方差 阵 O) 和 量 测 噪声 方差 阵 RG) 必定 为 0, 根据 预测 误差 阵 
方程 和 估计 误差 方差 阵 方程 , P(|& 一 1) 和 P(k |k) 都 将 为 0。 这 时 ,图 6. 3 的 也 点 
和 C 点 必 重合 在 一 起 。 

D 如 果 只 存在 系统 干扰 而 不 存在 量 测 噪声 ,那么 RCk) = 0 fii P | k—1)Z0, 
根据 前 面 的 讨论 ,增益 阵 变 成 单位 阵 ,也 就 是 说 ,总 是 把 新 息 作为 修正 量 对 预测 船 位 
进行 修正 。 这 时 ,图 6. 3 的 C 点 就 是 & 时 刻 的 真实 船 位 ,D 点 和 C 点 必 重 合 。 

(3) 如 果 只 存在 量 测 噪声 而 不 存在 系统 干扰 ,图 6. 3 的 B ARE k 时刻 的 真实 
船 位 ,DD 点 和 B 点 必 重 合 。 

O 如 果 系 统 干扰 大 而 量 测 噪声 小 , 即 P | £ — 1) 之 Re)， 这 时 增益 矩阵 
KC) 接近 1, 图 6. 3 KY D SOROR C 点 。 

(5) 如 果 系 统 干扰 小 而 量 测 噪声 大 , 即 RG) >P | k — 1), 这 时 增益 矩阵 
K(k) 接近 0, 表 明 难以 从 量 测 信息 中 提取 有 用 信息 以 改善 预测 估计 ,图 6. 3 y D A 
URRE B 点 。 

(6) 增益 矩阵 的 折 中 作用 。 在 量 测 船 位 与 预测 船 位 之 间 进 行 折 中 , 靠 的 是 增益 
和 矩阵 

K(k) = P(¿ | 有 一 1)BHTCE) [HPC | 天 一 1) HTCE) +R T 
为 了 便于 表达 , 设 状态 向 量 与 量 测 向 量 均 为 一 维 ,由 H) = 1 可 得 
K(k) = P(k | k—1) [PG | k—1) + RG) T: 

简化 后 的 增益 矩阵 含义 很 明显 , PCO | 4 一 1) 反映 预测 的 精度 , RCk) 反映 量 测 的 

精度 ,两 者 共同 决定 增益 的 大 小 。 
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已 知 滤波 方程 为 
Ck | k) = $G | k— 1) +KG(D[zG) — HCR) Ck | k—1)J 
将 增益 矩阵 代 人 上 式 得 
$G | k)= $G | k—1) +P(& | k—1)z(k)/CPCk | k—1) +RC)] 
P(& | k—1)£G@ | k—1)/CPC | k—1) +R@)J 
Pk | k— DiC | k—1)/CPCk | k — 1) +R] 
HR ECE | k— 1)/[P(G# | k— 1) +RG)J 
+P(& | E —1)z(&)/[PG | k—1) +RGJ 
Plk | k—1)8Ck | k—1)/CPCk | k—1) +RG)] 


Pa DFRO | k— D + Fe) 
上 式 表 明 , 最 佳 状态 估计 Ck | k) 实质 上 是 预测 估计 $C | 一 1) 和 量 测 值 的 线 
性 加 权 的 组 合 ,加 权 系 数 由 预测 误差 方差 和 量 测 误差 方差 的 大 小 决定 , 即 增益 矩阵 
的 作用 是 在 预测 量 和 量 测量 之 间 进 行 折 中 。 


6.3 ” 带 有 控制 项 和 测量 系统 偏差 时 的 卡尔 曼 滤波 器 


上 面 对 于 卡尔 曼 滤波 公式 的 推导 中 ,不 考虑 系统 模型 含有 控制 项 u, 且 测 量 方 
程 不 含有 测量 偏差 y, 的 情况 。 若 考虑 这 两 种 情况 , 则 系统 的 数学 模型 为 
x= Ora Xia + Wid + Th Wi (6. 3. 1(a)) 
r= Hx, +y +w (6.3.1(b)) 
此 时 ,系统 的 卡尔 曼 滤波 器 方程 与 6. 2. 1 小 节 中 的 不 同 之 处 只 在 一 步 最 优 预报 fu 
和 新 息 序列 Zia 两 项 。 
在 这 种 情况 下 ,一 步 最 优 预 报 为 























£ = Dra eia + Prit (6.3.2) 
新 息 序列 为 
Zaa = — Yi — bu 

= z — HOt + Pereiti] (6. 3. 3) 

于 是 , 带 有 控制 项 u, 和 测量 偏差 nx 的 卡尔 曼 滤波 方程 为 
Si 十 下 (6. 3. 4(a)) 
kl = Doh + Wu (6. 3.4(b)) 
Za = l — Ja — Hafia (6. 3. 4(c)) 
K, = Pam Hi [HPam Hí + RT (6. 3. 4(d)) 
Para = Dera Priim Dia HPna Qam (6. 3. 4(e)) 


P, = U — KH, Pye (6.3.4(f)) 
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6. 4 系统 干扰 和 测量 噪声 相关 时 的 卡尔 曼 滤波 器 


在 关于 卡尔 曼 滤波 的 讨论 中 ,都 假定 系统 干扰 w 和 测量 噪声 w 是 不 相关 的 ,但 
实际 上 ,有 些 时 候 二 者 是 相关 的 。 若 考虑 这 种 情况 , 则 系统 的 数学 模型 不 变 , 即 


x= Dex + Piit + Th Wi (6. 4. 1(a)) 
= Hix +w (6. 4. 1(b)) 
但 是 ,系统 干扰 w, 和 测量 噪声 o, 是 具有 如 下 特性 的 白 噪声 , 即 

E(w) = 0,R.,,(k,j) = Qy 

{ee = 0,R,(&,j) 一 Ron (6. 4. 2) 
G@,j) = Sy 
系统 初始 状态 xo 为 一 随机 向 量 , 且 有 

E(x) = Xo, Var(xo) = P, (6.4.3) 


上 述 系统 与 6.2. 1 小 节 中 不 同 的 是 , w 和 是 6 相关 的 。 为 了 利用 其 中 的 结果 , 首 
先 需 要 将 动态 方程 变形 ,以 解决 噪声 相关 的 问题 。 
在 方程 (6. 4. 1(a)) 的 右 侧 加 上 一 项 由 测量 方程 组 成 的 但 是 等 于 0 的 项 , 即 
x= Dea Xea Bde HDi Wea + J (za — HeX — 0-1) 
= (Oria —Je H, )xa + Wd Hiiti + Tw — J Ve 


= Dicre tt [Wd + Ize + we (6.4.4) 
@; = 有 一 JE 
(6.4.5 
式 中 a = Two 一 Je ur 2 


RCG. 4. 4) 与 式 (6.4. 1(a)) 是 等 效 的 ,新 的 控制 项 为 Paita 十 Jeazri， 新 的 动态 
噪声 为 we-:， 而 测量 方程 不 变 。 这 时 ,变形 后 的 动态 噪声 wi 与 测量 误差 w 之 间 的 
协 方差 阵 为 
Cov(Cw sw) = Elen awk — J,o,) oF 
= (TyaaS, —J,R,)ó, (6.4.6) 
若 令 Denas — J.R, = 0, Bl 
J = TaSiRe < (6.4. 7) 
则 有 CovOw ,u;) = 0, Bl, WR J, WE. RCG. 4. 7), 则 动态 系统 (6. 4. 4) 中 的 动态 品 
声 居 与 测量 误差 w 不 相关 ,这 样 就 可 以 利用 6. 2. 1 小 节 中 推导 卡尔 曼 器 的 方法 进行 
推导 。 
如 已 知 第 & 一 1 次 的 最 优 估计 值 名 141, 则 由 式 (6. 4. 4) 得 x, 的 一 步 最 优 预报 为 
如 一 Dt + Pride HJ 
= Drifa H Priti HJ lem — Hri] (6.4. 8) 
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而 一 步 预 报 的 估计 误差 为 
Fia = x, — l 
Demi [xi 一 如 ac] 一 大 [xzr — cu] 
HDW — Jai or (6.4.9) 








考虑 到 
P, = Elx 一 如 air] [xi =f ]" 
Cov(Cwriyxri) = 0, Covl Xr U01) = 0 
以 及 式 (6. 4. 2) 和 式 (6. 4. 7) ,得 一 步 预 报 误差 方差 阵 为 
P, = EC Xima he) 
= [On —J-uH, JEL 一 如 ar] 
X [xa — mm [Be — J B, J 
HJEL aJi] +e Wawa TE 
Tam Elw oi J — Je Elom wE WE 
= [@. J H, Prima lOr 一 JE 


+I, Q= TË — JRE (6.4.10) 
将 已 求 得 的 式 (6. 4. 8) 和 式 (6. 4. 10) 代 人 式 (6. 2. 5) , 式 (6. 2. 10) 和 式 (6. 2.11) ,得 
a = faia HKE — Hirm] (6. 4, 11) 
K, = Pa HI [H,P,,— HF +R] (6.4.12) 
Par = [I—K,H,]P,—, (6. 4. 13) 
综 上 所 述 , 得 w 与 v4 为 6 相关 时 的 卡尔 曼 滤波 器 递 推 方程 为 
kale = fara +K,[z, — Hifa] (6.4.14(a)) 
$a = Drite + Pde +J [za — H$i J 
(6.4.14(b)) 
J, = TSiRe (6.4.14(c)) 
K, = Pami H; [HiP HI + RJ (6.4.14(d)) 
P. = [Bi — Ji He Poy [Be — J aH, J" 
+I, Q Ta — JR, JE (6.4.14(e)) 
Pi = [I— KH Pe (6. 4. 14(f)) 


6.5 ”有色 噪声 下 的 卡尔 曼 滤波 器 


前 面 推导 了 线性 系统 当 模型 噪声 w 和 量 测 噪声 w 均 为 零 均值 高 斯 白 噪声 情况 
下 的 卡尔 曼 滤 波 公式 。 白 噪声 是 一 种 理想 的 噪声 ,一 种 实际 系统 的 噪声 总 有 一 定 的 
相关 性 ,只 有 在 相关 性 比较 弱 时 , 才 可 以 近似 看 成 是 白 噪 声 序列 。 但 是 , 当 噪声 序列 
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的 相关 性 不 可 忽略 时 ,就 要 考虑 有 色 噪 声 情况 下 的 卡尔 曼 滤 波 。 当 有 色 噪 声 w, 和 从 
可 以 用 白 噪 声 激发 的 线性 系统 一 成 型 滤波 器 得 到 时 ,可 通过 增 广 状 态 向 量 的 方法 
解决 。 





假设 系统 的 数学 模型 为 
IAHI) = B+ RR Hr k+l, WE) 《6.5.1(a)) 
z(&+1) = H,G-+ Dy(&+ 1) +o G+ 1) (6.5.1(b)) 
式 中 , m GQ) 和 v (&) 是 有 色 品 声 ,它们 分 别 有 一 个 成 型 滤波 器 , 即 
Wlk+1) = Dk +1,k)wi (k) +T,G +1,)m Q) (6. 5. 2) 
了 (十 1) = Blk+1,k) o Q) +H CR+1,k) mR) (6.5.3) 


AH, 各 量 维 数 如 下 ; y 为 n 维 向 量 , w 为 p 维 向 量 , m 28 q 维 向 量 ,z 和 vw 为 mm 维 向 
#t, m 为 > 维 向 量 , @ H nX n EE, T, A nX p EBE, D 298 pX pE, TH p X q 
PEBE, H, 为 mXn 和 矩阵 , @ 为 mXm 和 矩阵 , Ts 89 m>X r SEE, 其中, m CGO A m G) 
为 零 均值 白 噪声 序列 , 且 有 


E[m OE D] = Nu ða (6.5.4(a)) 
Elm (DR kY] = Na (0) (6.5.4(b)) 
E[m GE QD] = N. k)ða (6.5.4(c)》 


RP, Na GO) Na Ck) 和 N: Q) 分 别 是 gXgq 、rXr 和 9Xr 矩 阵 。 假 定 y(0).w(0) 
和 (0) 都 是 零 均值 高 斯 随机 向 量 ,其 协 方差 矩阵 分 别 为 pw CO) Puce (0) 和 pw(0)， 
它们 的 互 协 方差 矩阵 分 别 为 


ELy(O)wF(O)] 一 pw(O) (6. 5. 5(a)) 
E[ y(0) 21 (0)J = p» (0) (6.5.5(b)) 
E[ w. (0) z! (0)] = Pu (0) (6.5.5(c)) 
SE X z(k + 1) Ant p m EA RERA 
y&+1) 
xk +1) = [hato] C6. 5. 6) 
v(k+1) 
则 增 广 的 状态 方程 为 
x(&+1) = OH 1,k)x(&) 十 TCR 十 1 有 Wo( 有 ) (6.5.7) 
式 中 
(k+1,k) Ti(k+1,k) 0 
Dk 二 1,k) = Ë 0 Du G+ 1,b) 0 | 
0 0 D: (k +1,k). 
0 0 
TIT(k+1,k) = — 0 | 
0 T,(&+1,k) 
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"o= [Woo] 


x(0) H n + p +m 维 的 零 均 值 正 态 随机 向 量 ,其 协 方差 矩阵 为 
Pw(0) P(O) py (0) 
PO) = e PaslO) p. ol 
pw(0) pu(0) Pa (0) 
w(k) 为 9 十 r 维 的 零 均 值 高 斯 白 噪声 序列 ,其 协 方差 矩阵 为 
E[wG)wr(] = QG)8, = Ri W pad A 


Nk) Nz G) 
测量 方程 式 (6. 5. 1(b)) 可 以 写 为 
z(&+1)= HG&+ )x(&+ 1) (6.5.8) 





AT H(&-- 1) = [H.G&+ 1) 6 I) 
9 为 m X p NEHER, I 23 m X m RAER. 
由 式 (6. 5.7) 一 (6. 5. 8) 构 成 的 增 广 状态 系统 的 卡尔 曼 滤波 方程 为 


finen = $a HKin [Lz — H, Oria] (6.5.9(a)) 
Kin = Pau Hfa [Hen Pi u Hi, J (6.5.9(b)) 
Penja 一 Deri PaB ina + Dena Q Tas (6. 5. 9(c)) 
Penin = [I— Ken Hi Perii (6. 5. 9(d)) 


初始 条 件 为 如 lo = 0, Poo = Pos 

对 于 有 色 噪 声 情况 下 的 卡尔 曼 滤波 器 ,需要 说 明 以 下 两 点 : 

(1) 为 了 获得 状态 RR ERE n E EE n+ p+ E RAE 
滤波 计算 中 增加 一 定 的 工作 量 。 

(2 在 计算 滤波 增益 矩阵 时 , 求 逆 的 矩阵 中 不 包含 R, 项 ,使 得 求 逆 阵 可 能 为 奇异 的 。 
避免 这 一 问题 的 方法 是 在 有 色 噪 声 o (k + 1) 中 分 出 一 个 白 噪声 分 量 ,使 测量 方程 化 为 

z(k&+1)= H,(&+1)y(+ 1) +o ë+ 1) +m G + 1) (6.5.10) 

其 中 , n: Ck 十 1) 为 零 均 值 高 斯 白 噪 声 序列 ,其 协 方差 矩阵 RE 十 1) 对 任意 & 正定。 


6.6 卡尔 曼 滤 波 器 稳定 性 和 鲁 棒 性 


由 于 卡尔 曼 滤波 是 递 推 的 算法 ,需要 事先 设 定 初 始 值 。 此 外 ,滤波 器 有 效 的 前 
提 是 系统 模型 精确 已 知 , 这 包括 系统 的 结构 参数 精确 已 知 ,以 及 系统 干扰 和 测量 品 
声 的 统计 特性 已 知 。 这 样 ,自然 产生 下 面 的 问题 :GD 滤波 初 值 如 果 选 取 不 当 是 否 会 
对 以 后 时 刻 的 滤波 值 产生 影响 ? O 如 果 系 统 模型 不 准确 ,或 者 说 状态 方程 和 测量 方 
程 中 一 些 结构 参数 有 误差 时 ,这 对 滤波 值 的 影响 有 多 大 ? 该 如 何 度量 这 种 影响 ? 要 
本 答 上 面 的 问题 ,需要 研究 滤波 的 稳定 性 和 和 鲁 棒 性 。 
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6.6.1 卡尔 曼 滤 波 器 的 稳定 性 


在 用 卡尔 曼 滤波 器 对 某 个 系统 进行 滤波 时 ,首先 需要 设 定 估计 初 值 名 和 初始 的 
估计 误差 方差 矩阵 P。 由 于 对 初始 状态 的 均值 和 方差 等 统计 特性 了 解 得 不 准确 , 因 
而 这 两 个 值 不 能 确切 知道 。 如 果 无 论 初 值 怎样 选取 ,只 要 滤波 的 时 间 充分 长 ,都 能 
保证 以 后 的 滤波 值 与 最 优 滤波 值 任意 接近 ,那么 称 滤波 器 是 稳定 的 。 下 面 讨论 滤波 
器 的 稳定 条 件 。 

1, 滤波 的 稳定 性 问题 及 滤波 稳定 性 定理 

为 了 方便 讨论 问题 ,首先 回顾 线性 系统 的 稳定 、 渐 近 稳定 和 一 致 渐 近 稳定 的 


对 于 齐 次 线性 离散 时 间 动 态 系统 
x, = Dri Xe (6.6.1) 
(1) 如 果 存 在 常数 c > 0, 使 得 对 所 有 的 三 0, 都 有 l| Do || < c, 则 称 系统 是 
稳定 的 。 


(2) 如 果 存 在 常数 c > 0, 使 得 对 所 有 的 & 之 0, 都 有 || Dao || <c, B34 k— co 
Bf, I Duo l| 一 0, 则 称 系统 是 渐 近 稳定 的 。 

(3) 如 果 存 在 常数 c > 0,cs > 0, 使 得 对 所 有 的 上 之 ! 过 0 时 ,都 有 IDa | < 
ce 9， 则 称 系统 是 一 致 渐 近 稳定 的 。 

以 上 三 种 稳定 性 之 间 的 关系 是 :由 一 致 浙 近 稳定 性 可 推出 渐进 稳定 性 ,由 渐进 


稳定 性 可 推出 稳定 性 。 
对 于 随机 线性 离散 系统 
š x = Dra Xia + Th We (6.6.2(a)) 
x = Hix, +ú (6.6.2(b)) 
其 滤波 方程 为 
$ = raira HK [aa — HD] (6. 6. 3) 
或 
$, = Bt HK (6. 6. 4) 


式 中 , W,,— = UKH: JO 为 滤波 系统 的 转移 矩阵 , Ker 为 滤波 系统 的 输入 项 。 

可 以 通过 分 析 方 程式 (6. 6. 3) 相 应 的 齐 次 方程 研究 滤波 的 稳定 性 问题 。 由 于 方 
程式 (6. 6. 3) 与 一 般 的 齐 次 方程 完全 相同 ,因此 可 用 李 亚 普 诺 夫 第 二 法 则 判定 滤波 
的 稳定 性 问题 。 

对 于 系统 (6. 6. 2) 的 卡尔 曼 滤波 问题 ,有 结论 如 下 :如 果 齐 次 方程 

$ = Parif (6.6.5) 
所 描述 的 系统 是 一 致 渐进 稳定 的 , 则 滤波 是 稳定 的 。 
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假定 方程 (6. 6. 5) 有 两 个 不 同 的 初 值 名 。 和 tio 将 它们 分 别 代入 方程 ,可 得 两 
个 不 同 的 解 


£ = Pro foio 
人 一 Profo 
将 两 式 相 减 得 
£ 一 = ,0 (bolo — 0 ) (6. 6. 6) 
在 (6. 6. 6) 左 右 两 侧 取 范 数 ,得 
|a — $ || < l| W, || + || $o — $o I (6.6.7) 


对 于 (6. 6,7), 当 很 大 时 ,如 果 范 数 || Pro | — o, W| $, — Liia s 此 时 还 可 以 证 
明 Pi — Pir, 即 滤 波 是 稳定 的 。 结 合 稳定 性 的 定义 可 知 ,只 要 滤波 系统 是 渐 近 稳定 
的 , 即 当 k 一 co 时 || Wao || 一 0, 则 滤波 是 稳定 的 。 为 了 使 滤波 系统 在 物理 上 是 可 实现 
的 ,要 求 有 界 的 输入 必须 得 到 有 界 的 输出 ,因此 要 求 滤波 系统 是 一 致 浙 近 稳定 的 。 即 对 
于 齐 次 方程 (6. 6. 5) ,如 果 存在 常数 c >> 0,cs > 0, 使 得 对 于 任意 的 三 /1 宇 0, 满足 
[Wl < cee aee 人 (6. 6. 8) 
如 果 滤 波 系统 是 一 致 浙 近 稳 定 的 , 当 很 大 时 , 必 有 I Wao | — o, 则 滤波 是 稳 
定 的 。 
对 于 连续 系统 ,滤波 方程 为 
$G) = AC EC) HKO) 一 再 (D)2(1)] (6. 6. 9) 
对 应 的 齐 次 方程 为 
ia) = AW) (6. 6. 10) 
式 中 
AG) = AG) — KC HO) 
设 齐 次 方程 (6. 6. 10) 的 转移 矩阵 为 WO, to), 对 不 同 的 初 值 &(t) AE Go), 3r 
程 得 到 不 同 的 解 , 即 
EC) 一 W(t,t) $G) 
$" G) 一 更 (tyto)8 Cto) 


将 以 上 两 式 相 减 ,得 
$G) — E (0) = We,to) LRG) — $* (to)] (6.6.11) 
在 (6. 6. 11) 等 号 两 侧 同时 取 范 数 , 得 
| $G) —+* G) || < || WG, || IE) — “° Go) | (6. 6. 12) 


34 RAKET UR WC, )— 0, WJ $G) — G), AEA PO — P (1), 即 只 要 滤 
波 系统 是 稳定 的 , 则 滤波 也 是 稳定 的 。 同 样 ,为 了 使 滤波 系统 在 物理 上 是 可 实现 的 ， 
要 求 有 界 的 输入 必 有 有 界 的 输出 ,因此 要 求 滤波 系统 是 一 致 渐 近 稳定 的 。 对 于 连续 
系统 的 齐 次 方程 (6. 6. 10) ,一 致 渐 近 稳定 的 充 要 条 件 是 :如 果 存 在 常数 cr > 0,cs > 
0, 使 得 对 于 任意 的 + 大 x, > 0, 满足 
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|| WG) || < ere (6.6.13) 

如 果 滤波 系统 是 一 致 浙 近 稳定 的 , 当 t 很 大 时 , 必 有 W(t,) 一 0, 则 滤波 是 稳 
定 的 。 

以 上 分 别针 对 线性 离散 系统 和 线性 连续 系统 ,形式 上 得 到 了 滤波 系统 一 致 浙 近 
稳定 的 条 件 , 即 式 (6. 6. 8) 和 式 (6. 6. 13) ,但 是 在 转移 矩阵 Pei 和 系统 矩阵 A(z) 中 
分 别 含有 增益 K, MEKO. H K, MEKO 一 般 无 法 解析 表示 ,因此 用 上 述 方法 难以 
判定 滤波 的 稳定 性 。 

考虑 到 滤波 方程 是 从 系统 的 状态 方程 和 观测 方程 推导 出 来 的 ,那么 滤波 的 稳定 
性 应 该 与 随机 线性 系统 的 结构 和 参数 有 关 。 

卡尔 曼 等 人 通过 对 随机 线性 系统 的 研究 得 出 结论 :如 果 随 机 线性 系统 是 一 致 完 
全 能 控 和 一 致 完全 能 观 的 ,那么 其 线性 最 优 滤波 系统 是 一 致 渐进 稳定 的 。 这 就 是 
说 ,判定 一 个 最 优 滤波 系统 是 否 为 一 致 渐 近 稳定 ,只 需 考察 这 个 系统 本 身 是 否 为 一 
致 完 全 能 控 和 一 致 完全 能 观 ,如 果 满 足 , 则 滤波 初 值 CO) 和 PC0) 可 以 任意 选取 。 

下 面 首先 回顾 随机 线性 系统 的 能 控 性 和 能 观 性 。 

1 随机 线性 系统 的 能 控 性 

设 随 机 线性 离散 系统 的 状态 方程 为 

= Ori Xe + Th we (6. 6. 14) 
式 中 , w 是 零 均 值 白 噪 声 序列 , 且 Ew) = Qy 。 

随机 线性 系统 式 (6. 6. 14) 完 全 能 控 的 充 要 条 件 是 :对 于 时刻, 如果 存在 正 整数 

N, 使 
We 一 N 十 1 = p eLm (6. 6, 15) 


随机 线性 系统 (6. 6. 14 一 臻 完全 能 控 的 充 要 条 件 是 ， 如 果 存 在 正 整数 N AMERA > 
a > 0, 使 得 对 所 有 的 上 之 N, 有 





af 和 Wec( 一 N 十 lb SAI (6. 6. 16) 
2) 随 机 线性 系统 的 能 观 性 
设 随机 线性 离散 系统 的 观测 方程 为 
xz = Hx, + vw (6.6.17) 


式 中 , w, 同 式 (6. 6. 14), vw 是 零 均值 白 噪 声 序列 , 且 Eloo) = Ru o 
随机 线性 系统 (6. 6. 14) 完 全 能 观 的 充 要 条 件 是 :对 于 & 时 刻 ,如 果 存 在 正 整数 
N, 使 
Wolk— N+1,k) = > DHFR; HD; > 0 (6.6.18) 
随机 线性 系统 (6. 6. 14) 一 臻 完全 能 观 的 充 要 条 件 是 ， 如 果 存 在 正 数 应 之 > 0 


及 正 整数 N, 使 得 对 所 有 的 之 N, 有 
aI KWolk—N+1,k) < QI (6. 6. 19) 
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在 滤波 系统 中 ,滤波 误差 方差 矩阵 是 对 滤波 误差 的 一 种 度量 。 对 于 稳定 的 滤波 
系统 , 随 着 滤波 时 间 的 增长 ,滤波 误差 方差 矩阵 应 该 逐渐 趋 于 稳定 值 。 在 证 明 稳 定 
性 定理 时 ,需要 知道 滤波 误差 方差 的 界 , 下面 讨论 它 的 上 下 界 问 题 。 

定理 6.1 如 果 离 散 随机 线性 系统 

= Orii Xe +T,—-iW=4 
z = H,x, +o 
是 一 致 完全 能 控 和 一 致 完全 能 观 的 , 即 存在 正 数 mw f 、as、B 和 正 整数 N, 使 得 对 于 
所 有 的 & 之 N, 有 





af<Wc(k 一 N 二 1 人 去 BT 
a I< Wo 一 N 二 LA) 去 BT 
假定 P, > 0, 则 对 于 所 有 的 & 宇 N, P, 有 一 致 的 上 界 和 下 界 , 即 


1 十 到 
了 Irea < P. < I (6. 6. 20) 


定理 表明 ,对 于 一 致 完全 能 控 和 一 一 致 计 全 能 观 的 随机 线性 系统 ,其 滤 汲 误差 方 
差 矩 阵 P, 对 所 有 的 & > N 有 一 致 的 有 限 上 界 。 也 就 是 说 , 随 着 滤波 时 间 的 延长 , 滤 
波 误差 方差 矩阵 不 会 无 限 增长 。 

如 果 P, > 0, 则 由 式 (6. 6. 20) 可 以 看 出 , P, 总 有 一 致 的 正定 下 界 。 因 此 ,对 于 
一 致 完全 能 控 和 一 致 完 全 能 观 的 随机 线性 系统 , 当 P. > 0 时 , 随 着 滤波 时 间 的 延长 ， 
滤波 误差 方差 矩阵 总 是 正定 的 。 

3) 滤波 的 稳定 性 定理 

系统 式 (6. 6. 2) 的 卡尔 曼 滤波 方程 为 

Bi = Ora eia HK (z — HOr e) 
= (I—KH)@B te HK (6. 6. 21) 
AP, K, 为 增益 矩阵 , 即 
K, = Pu Hí (HPu H] +R)? 
H Ôn = (一 KUHz)G@e ly， 则 滤波 方程 可 写 为 
Blt = Bt +K, (6. 6. 22) 

如 果 把 式 (6. 6. 22) 看 成 一 个 新 的 线性 系统 ,其 中 D 为 新 的 转移 矩阵 , Kizi 为 
系统 的 输入 项 , 则 有 如 下 的 滤波 稳定 性 定理 。 

定理 6. 2 (滤波 稳定 性 定理 ) 若 系统 

= Bre +T, we 
x= = H,x, +w 
为 一 致 完全 能 控 和 一 致 完全 能 观 的 , 则 滤波 式 (6. 6. 21) 是 一 致 渐 近 稳定 的 , 即 存在 
常数 c > 0,cz > 0, 使 得 对 所 有 的 上 之 ! 0, 都 有 
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l| Dau || <= ese (6. 6. 23) 

证 明 从 上 略 。 

根据 滤波 稳定 性 定理 ,可 以 得 出 以 下 结论 : 

结论 1 对 于 一 致 完全 能 控 和 一 致 完 全 能 观 的 线性 系统 , 若 时 间 充分 长 , 则 其 卡 
尔 曼 最 优 滤波 值 将 渐 近 地 不 依赖 滤波 初 值 的 选取 ,而 且 有 界 的 测量 输入 必 有 有 界 的 
滤波 输出 。 

结论 2 ”如果 PQ APP 是 两 个 不 同 的 初始 误差 方差 矩阵 ,而 PI MPP 分 别 为 
从 它们 出 发 按 卡尔 曼 最 优 滤波 器 算出 的 第 上 时刻 的 滤波 误差 方差 矩阵 , 则 存在 常数 
b > 0,b > 0, 使 得 对 所 有 的 上 之 2 之 0, 有 


|| PP — PP || < be h@- || PP — PP || (6. 6. 24) 
即 对 于 一 致 完全 能 控 和 一 致 完全 能 观 的 线性 系统 , 当 & — co 时 ,有 

| PP — PP || < beht || PP — PP | — 0 (6. 6. 25) 
即 当时 间 充 分 长 , 它 的 滤波 误差 方差 矩阵 及 滤波 增益 矩阵 将 渐 近 地 不 依赖 初始 方差 


矩阵 的 选取 。 
对 于 线性 定常 系统 , 即 Oi =Q, =T, H = H,Q, =Q>0,R, =R>0, 
这 时 , 当 & 之 N 时 ,有 


k 
Wce(—N-+1,)= J) OTOTT o)" 
i=k-N+1 








Na 
= S Orr" 0)" (6.6. 26) 
l=0 
k 
WoGk—N+1,)= J) (@-OTH'R'1HOF* 
j=k-N+1 


ne 
= “q say > (TER RD Jo (6. 6. 27) 
名 


根据 式 (6. 6. 26) 和 式 (6. 6. 27) ,可 以 推出 线性 定常 系统 的 完全 能 控 性 与 完全 能 
观 性 , 即 一 致 性 总 能 满足 。 也 就 是 说 ,线性 定常 系统 一 致 完全 能 控 与 一 致 完全 能 观 
的 充 要 条 件 分 别 为 


Wt 
S OIT" (0 >o (6. 6. 28) 
i=0 


Nl 
> (@)THTHG: >0 (6. 6. 29) 
人 0 


式 中 , N 为 状态 变量 维 数 。 

结论 3 ”对 于 线性 定常 系统 , 若 系统 为 完全 能 控 和 完全 能 观 , 则 存在 一 个 唯一 的 
正定 矩阵 P, 使 得 从 任意 的 方差 矩阵 P, 出 发 , 当 & — co 时, 恒 有 P, — P. 

例 6.3 系统 的 状态 方程 和 观测 方程 表示 为 
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ntD] Fl Taa], FT/2 

Eain b JER T pw 
x(k) 
z% =[1 0] Er 
Ë w(z) AI o k) 都 是 均值 为 零 的 白 噪声 ,又 互 不 相关 , 且 有 

E[wCb] = Elo (A] = 0 

E[w(k)w! G)] = @, = h 

E[o Q) o" GY] = Ry = Pòu 
试 判 定 卡 尔 曼 滤波 系统 的 稳定 性 。 
8 由 系统 方程 和 观测 方程 可 知 


ea =[ 了 na a =[2] m= o 


Fe Ck) 


0 1 
1 I-T 1 2T 
K armea EE] 
1 211 T 1 3T 
Diria = BBs = [0 | il- [; S 
IR 1 (k—i) 
ol 
0 1 


首先 求 能 控 性 矩阵 WcCk 一 NN 十 1,k)。 


由 
or IT, = [ RAE 1 °] 





0 = -DT 1 
+ DT + Te + DT 
于 + (DT 1 


可 得 ç 
We.k—N+1,)= 2) BT aQ. IT. DE 
i=k-Nł 





ar 3 +E-DT HRDT 了 十 修一 DT 
=m 
Esa 到 十 人 一 DT 1 
Np -Npe NT 
3 12 2 
=¢T N 0 
¥r N 


因此 ,系统 一 致 完全 能 控 。 
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下 面 求 能 观 性 矩阵 Wo(k 一 N 十 1,&)。 
由 


1 G—b 
IT HIR-H x 10 Ë a 
oR aon [ ; ` əri Bluo 
=4 2 sola] 
mLG 一 DT GRYT 
可 得 
k 
Wo(k—N+1,)= >) OLHIR HD, 
j= N+ 
p £ [ I gen] 
Pinal GRT G—k Te 
N 一 去 NN 一 DT 





ENCN— DT EN(N—DOQN— DT 


因此 ,系统 一 致 完全 能 观 。 
由 稳定 性 定理 可 知 , 滤 波 系统 是 稳定 的 。 


2. 稳 态 卡尔 要 滤波 
根据 上 述 稳定 性 结论 ,对 于 线性 定常 系统 
x = ri 十 Twin (6. 6. 30(a)) 
= Hx, +w (6. 6. 30(b)) 


Zj 
若 系统 具有 完全 能 控 性 和 完全 能 观 性 , 即 满足 
只 wrrr (@)T>0 
l=0 
š: (dy)TH1 Bo! > 0 


= 
则 式 (6. 6. 30) 具 有 滤波 稳定 性 。 这 时 ,无论 如 何 选取 滤波 初 值 &(0), 从 任意 的 初始 
方差 阵 P, 出 发 , 若 时 间 充分 长 , 它 的 滤波 误差 方差 阵 Pu 将 趋 于 一 个 唯一 确定 的 正 
KEREP, 从 而 使 滤波 增益 矩阵 K, 也 趋 于 一 个 唯一 确定 的 增益 阵 玉 。 这 样 , 当 滤波 达 
到 稳 态 后 ,滤波 误差 方差 阵 将 趋 于 一 个 确定 的 正定 阵 , 并 且 可 以 离线 计算 ,从 而 避免 
了 大 量 的 在 线 计算 ,易于 工程 实现 。 
根据 离散 卡尔 曼 滤波 公式 可 以 计算 出 
Par = Pari — Pai H" (HP,, H" +R) HP; (6. 6. 31) 
Pi = @P; 61 +IOTT (6. 6. 32) 
将 式 (6. 6. 31) 代 入 式 (6. 6. 32) ,得 
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Penin = @[P,i-+, — P, H" (HP, IH! + R) HP ar JO +r" 
(6.6.33) 
式 (6. 6. 33) 被 称 为 黎 卡 提 差 分 方程 , 它 决 定 着 增益 矩阵 
K, = Pam H" (HP, H' + R) (6.6.34) 
当 滤波 器 达到 稳 态 时 ,有 
P, > P,K, > K, Pim 一 PH 一 RM 
此 时 , 黎 卡 提 差 分 方程 退化 为 黎 卡 提 代数 方程 , 即 
M = [M — MH! (HMH + R): EMVM]OI 二 TOF7 (6.6.35) 
稳 态 卡尔 曼 滤 波 增益 阵 和 滤波 误差 方差 阵 为 


K = MH! CHMHT 十 R) (6.6.36) 
P = M—MHT (HMH -+- R) ` HM (6. 6. 37) 

这 时 的 稳 态 卡尔 曼 滤波 方程 为 
$, = De HK la — HO$, ur A] (6. 6. 38) 


6. 6.2 卡尔 曼 滤波 器 的 鲁 棒 性 


1. 卡尔 受 滤波 器 模型 误差 分 析 

由 前 面 的 讨论 可 知 ,卡尔 曼 滤波 器 是 线性 最 小 方差 估计 , 并且 当 系统 为 一 致 完 
全 能 控 及 一 致 完全 能 观 时 ,滤波 器 还 是 稳定 的 ,但 这 些 是 以 精确 已 知 系统 的 数学 模 
型 和 噪声 统计 特性 为 前 提 的 。 在 工程 实际 中 ,常常 对 系统 的 认识 不 完全 或 在 建 模 过 
程 中 对 系统 进行 了 简化 处 理 ,另外 ,对 噪声 的 统计 特性 也 很 难 精确 了 解 。 以 上 因素 
使 得 在 理论 上 是 最 优 且 稳定 的 卡尔 曼 滤波 器 ,而 在 实际 应 用 中 却 可 能 是 发 散 的 。 由 
系统 建 模 误差 或 者 系统 参数 变化 而 使 卡尔 曼 滤波 器 保持 稳定 的 性 能 称 为 卡尔 曼 滤 





波 器 的 鲁 棒 性 。 
设 系统 真实 的 数学 模型 为 
x, = Bixie + Th Wi (6. 6. 39(a)) 
z = Hix, + (6. 6. 39(b)) 
对 系统 建 模 时 得 到 数学 模型 为 
x, = Bk t+ TW (6. 6. 40(a)) 
x, = H,x, + %, (6.6.40(b)) 
AH, I 


EW) = 0,R,,(&,j) = Ody 
E) = 0,R;,(k,j) = R,à 
R. (kj) = 0,R lks j) = 0,Re (k, j) = 0 
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滤波 初 值 xo 的 统计 特性 为 
Xo; = E(B),Po = Var(¥) 
因此 ,实际 采用 的 卡尔 曼 滤 波 器 递 推 方程 为 
Xu = Xu +K,[z, — Him] 
Xaa = Orea 
K, = Pon HI [HP BE +R,J ' 
Bi = Deea Priim Diim +T, iQ IT, 
B= OU — KA, Pam [I KA," + K,R,KT 
= [I— KH Pu 


(6. 6. 41(a)) 
(6. 6. 41(b)) 


(6. 6. 41(c)) 
(6.6.41(d)) 


(6.6.41(e)) 


由 于 xu FRE x, 真实 的 最 优 滤波 值 , Bs 也 不 是 真实 的 最 优 滤波 误差 方差 矩阵 ,因此 
为 了 衡量 滤波 的 优 劣 ,需要 考察 真实 状态 x, IRR a 之 间 的 误差 及 方差 矩阵 。 


令 
X, 一 了 一 了 一 

Pi= EIE) Pimi = Eaa YH) 

AB = @,.— — D , AH, = H, — B, 

由 式 (6. 6. 1) 和 式 (6. 6. 3(a)) 得 

T= X, — Ëra 
= x et K,[H,x, +>, — Mam] 
= U~- KA, ] Xam —K,AH,x, — K, 


一 X, — Fia 











= Bixe HDi Wea — Demi Erim 
= Be + ADe Te HIW 


于 是 有 
Pi= Elza} 


= [I—RKH Pl[I— KH] + K,AHA,AHIKT 
+ RRKE —[1— KH, J]B AAF 
—KAHBu LT 一 本 再 
Pia = Br Pha Bh + AG, IA. AGL. 
HDi QTE +@,, Bh Di 
FAD: Bim Dim 
其 中 ， A, = EGxxE) B, = ESF), Bi 一 Eafe) 
A, = Dri Ar Diri +T, iQ: Th 
B, = B,— [I —K,B, |! +A;AHIKI 








(6. 6. 42) 


(6. 6. 43) 


(6. 6. 44) 


(6. 6. 45) 
(6. 6. 46) 
(6. 6. 47) 
(6. 6. 48) 
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B, = BB Dh + DA Dim Hmmm (6.6.49) 
上 述 递 推 公式 的 初 值 分 别 为 
Pš = ELxo — xo ] [x — x+ J" 
A; = E(xex2) 
B, = E[ xo (xo —x)1 J 

式 (6. 6. 44) 一 式 (6. 6. 49) 是 考虑 了 模型 误差 对 滤波 效果 产生 影响 的 计算 公式 。 
由 于 实际 系统 的 真实 数学 模型 并 不 明确 ,所 以 这 些 公式 很 难 应 用 在 实际 中 。 

如 果 只 考虑 滤波 初 值 各、 初始 方差 阵 P. 及 噪声 方差 阵 Q, 和 Rs 有 误差 , 即 
Di = BH = H, Dr = Tr 这 时 式 (6. 6. 44) 和 式 (6. 6. 45) 简 化 为 


Pi = [I—K.H,]JP;, [I— RH + K.R,KT (6. 6. 50) 
Pl = Dema Ph DE Himm (6. 6. 51) 
而 式 (6. 6. 41(d)) 和 式 (6. 6. 41(e) ) 分 别 为 
Pu = DP Dh tT QTh (6. 6. 52) 
P, = [I—RKH Bu UKH] +K,R,KT (6. 6. 53) 


令 z # 
AP, = P, —P, APum = Parma — Pur 


由 式 (6. 6. 50)—(6. 6. 53) 得 
AP, 一 [I—K,H,JAPu, KH] +K,[R, — RIKE (6.6.54) 
APum = Bors AP, DE Dua [Qa —Q Ia a (6.6.55) 
WRR Q, > Q, ,R, > R,, 那么 只 要 AP, 二 0, BI P, , > Ph, UA AP > 
0, 即 Piri Z Pimi > 从 而 AP, > 0, 即 P, 之 Pi。 于 是 有 下 面 的 结论 : 
结论 1 在 初始 滤波 值 ,初始 方差 矩阵 和 噪声 协 方差 矩阵 有 误差 的 情况 下 ,如 果 
P, > Pi, 且 对 所 有 的 有 选取 @ = Q, ,R, >Re WISA H k RA P, > Pi。 
结论 2 在 初始 滤波 值 ,初始 方差 矩阵 和 噪声 协 方差 矩阵 有 误差 的 情况 下 ,如 果 
P, > Pi, 且 对 所 有 的 有 选取 @ < Q. ,R, < R,, WIRA k RA P, < Pi。 
结论 3 若 模 型 线性 化 系统 具有 一 致 完全 能 控 和 一 致 完全 能 观 性 , B P, > P;， 
9, > QR: >R, WA Pi < P, < yI, 
由 上 面 的 结论 可 知 ,对 于 某 些 实际 问题 ,虽然 不 能 确定 真正 的 $. P3 Q AR, 
但 通过 适当 调整 B O MR., 可 使 所 设计 的 滤波 器 在 规定 的 误差 范围 内 很 好 地 
工作 。 
2. 滤波 的 鲁 棒 性 定理 
设 系统 的 真实 模型 为 
x, = Dra Xia + Tia we + Wrei (6.6.56(a)) 
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x, = H,x, +w (6. 6. 56(b)) 
而 实际 采用 的 模型 化 系统 为 
x, = maem + TW + ,il (6.6.57(a)) 
z = B,x, +%, (6.6.57(b)) 
当 系 统 中 的 参数 在 一 定 范围 内 发 生 摄 动 或 模型 化 系统 具有 建 模 误差 ,卡尔 曼 滤波 器 
的 滤波 值 仍 能 保持 不 发 散 , 即 
如一 和 天 co 一 co C6. 6. 58) 


则 称 该 系统 的 卡尔 曼 滤 波 器 具有 重 棒 性 。 
引 理 ERG. 6. 56) 和 式 (6. 6. 57) 为 一 致 完全 能 控 和 一 致 完全 能 观 , 则 有 如 下 
结论 ， 
D ||, — u || < ce 等 价 于 || x —x || < co 一 co 
(2) [| x, — Fu | 一 ce 等 价 于 |x —x| —°,k— o° 
(3) ECx, — Er) = E(x, — F) (k > 1) 
证 ”由 于 两 个 系统 均 为 一 致 完全 能 控 及 一 致 完全 能 观 ,因此 
ll Ea —x | < 00 ( 当 & 一 co) 
于 是 由 A 
|x, —x || < |x —x, || + l| E —x I 
可 知 ,车 |x —x | < ° CQ k — so ), 则 有 
|l xs — Fai || < o0 (8 k— o0 ) 
另 一 方面 ,由 
|z, —x || < |x — Er || + lt —x ll 
可 知 ,车 | x¿ — xu | < c° (2 k — co), 则 有 
|x —x || < o0 G4 £— co) 





于 是 等 价 关系 (1) 得 证 。 

同 理 可 证 等 价 关系 (2)。 

由 卡尔 曼 滤波 x, H x, 的 无 偏 估 计 可 知 ， 

下 (Bt = E(x,) 

于 是 等 价 关 系 (3) 得 证 。 

根据 上 述 引 理 ,可 得 如 下 结论 : 

结论 1 若 系 统 (6. 6. 56) 和 系统 (6. 6. 57) 为 一 致 完全 能 控 和 一 致 完全 能 观 , 且 
渐 近 稳定 , 即 存在 cl > 0,c > 0, 使 得 

IDe | << es yk > 1>0 (6. 6. 59) 

则 系统 (6. 6. 56) 的 卡尔 曼 滤 波 器 具有 和 鲁 棒 性 。 

证 由 于 

|| x —x | < || x; — E(x,) HEC) — E(x,) + E(z,) —, | 
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< la — Eœ || + || Eœ) — EGx) || + || x, — EG) I| 
= Atr Var] + || ECx) — EC) || + /trVar(Xx,) (6. 6. 60) 


k 
trVar( z) = Do Var xo Do) + 276, T QT 6.6.61) 


f 
于 是 
tr[ Var(x,)] = tr[Var(xe Fo.) ] + 27 rT QTDE D) 
m (6. 6. 62) 
再 由 于 Var(xo) 和 OLo@,., 都 是 非 负 定 阵 , 故 有 
tr[Var(xo BEo D0)] < max[A; (Olo Do) Jtr[ Var(z,)J = || Dio || ° tr[ Var(x;)J 
(6.6. 63) 
将 式 (6. 6. 63) 代 入 式 (6. 6. 62) ,得 


k 
tr[Var(x,)J< | Duo || °tr[Var(x.)]+ 2 || @,, I tram) 


= 
š 
委 tr[Var(xocie at)] 十 >) Ga t, Qam) 
= 
suptr(T,-iQ IT )c 
B: Lenka (6. 6. 64) 


I= 


同 理 可 证 
tr[Var(x,) ] < co 人 一 co (6. 6. 65) 


此 外 ,由 模型 (6. 6. 56) 及 式 (6. 6. 57) 可 知 
k 
E) — ER) = @.,[EGz) —EG)]+ DDR — W. n.) 


. 


k 
< | ® || | Eœ) — EG) | +> D l| l Bmt — Wu. | 


k 
< QE || Eœ) — EG) | +2 Gm || Az. || 
= G, || Aw, | 
1— e 
RH, || Am... || = sup | 更 ,ar — Priit || 。 

将 式 (6. 6. 64)—(6. 6. 66) 代 入 式 (6. 6. 60) ,可 得 

|x, —x, || < co 一 co (6. 6. 67) 
结论 2 设 线性 定常 系统 为 

x = Bre HIW + Ws (6. 6. 68(a)) 
z = Hx, +o (6. 6. 68(b)) 


py (6. 6. 66) 
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具有 参数 摄 动 的 系统 模型 为 
x, = m HIW + aa, (6.6. 69(a)) 
x, = Hx, +% (= Hx, +T) (6. 6. 69(b)) 
若 系统 (6. 6. 68) 和 (6. 6. 69) 为 完全 能 控 和 完全 能 观 , 且 状 态 转移 矩阵 满足 
lol <1, 8 


max[Ai (BD)] < 1 (6.6.70) 
则 系统 具有 抗 参数 摄 动 鲁 棱 性 。 
证 因为 
|x —x || < VELVarCxzs) 十 | ECGx,) — E(x,) || + /tr[Var(x,) 
(6.6.71) 


tr[ Var(z,) ] < Ø Var(zo) [ @* ]T + Soror" Co] (6.6.72) 
= 
所 以 当 ol 二 1 时 ,有 
tr[Var(x,) ]< tr[ Var(x,) J[ @* J! 十 > tr[IOTT] [gr ire: 


< l@ |#*u[Var(x,)]+ 5) 1olzeoutrorr] 


=I el: < oko (6. 6. 73) 
及 
tr[Var(x.)J < UD <=,k— o0 (6. 6.74) 
|| Eœ) — E(x.) || < l| @ || * || Ecz) — EG) || + > le ll: | wu, — Wu, | 
£t 

-| <- 一 = (6. 6. 75) 

将 式 (6. 6. 73)~(6. 6.75) 代 入 式 (6. 6.71), 有 
|x, — x || <o, — co (6.6.76) 


再 由 引 理 的 等 价 关系 (1) ,得 
|z; — X || < co 一 co (6.6. 77) 
于 是 系统 (6. 6. 68) 具 有 参数 摄 动 鲁 棒 性 。 
结论 3 线性 定常 系统 (6. 6. 68) — (6. 6. 69) 完全 能 控 和 完全 能 观 , 若 
lel <1, E 


则 有 


E(xo) 天 下 (zi),Var(xo) Z Var(X) 


|x —x | = jx 一 名 < cok > oo (6.6. 78) 
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结论 4 线性 定常 系统 (6. 6. 68) 和 (6. 6. 69) 完全 能 控 和 完全 能 观 , 若 
maxLi(@)] < 1, H Wu, — Wu, = AW ( 常 向 量 ), 则 有 
|| ECx) — E) || < so,k — co (6. 6. 79) 
证 由 引 理 中 的 (3), 有 
EC) — E(%,)= E(z,) 一 下 (zu) 


k 
一 办 [ECx) 一 E(z)] 十 (> 0) Au (6. 6. 80) 
k=1 


又 由 于 max | Ni(@) |< 1， 故 有 
Jimg = oj 六 or <= 
将 上 述 结果 代 人 式 (6. 6. 80) ,得 
E(x,) — E(x,) < co,k — co 
于 是 有 || Ex) — E(x,) || < co 一 co 
证 毕 。 
结论 5 线性 定常 系统 (6. 6. 68) 和 式 (6. 6. 69) 完 全 能 控 和 完全 能 观 。 
DH max[hi(@)] > 1, B [EGo) —EC%)] [E(x。o) 一 E(x3o)]" >>0,u 没 有 报 
动 , 则 存在 一 个 & 值 ,使 得 


|| EG) — EG) || — co (6.6.81) 
(DË ma À (0)] > 1, B [Yu — Wa] [Wu — u] > 0, W — Wu 2998 88k, | 
|| Eœ) — EG%,) || — co 一 co (6. 6. 82) 


证 当 max | ACO) |> 1, FERE k, DERM k> ka BE, 有 站 一 | te — co, 
k— c0, 再 由 式 (6. 6. 80) 和 [EC%) — EGo) J [ECw) — ES) T > 0 可 知 式 (6. 6. 81) 成 立 。 

当 maala (OJ >>1 时 ,有 ji 六 gr — so,k — eo, 再 由 式 (6.6.80) 和 [Wi 一 
Wa] [wu — PT > 0 可 知 式 (6. 6.82) 成 立 。 


6.7 线性 离散 系统 的 最 优 预 测 与 平滑 


6.7.1 线性 离散 系统 的 最 优 预测 


对 于 线性 离散 随机 系统 
x; 一 Dra Xie + Th we (6.7.1(a)) 
x = Hx, + (6.7.1(b)) 
最 优 预测 问题 ,就 是 在 给 定 的 假设 条 件 下 ,根据 观测 数据 ma ,zz ,zi， 对 系统 在 
k(k > j) 时 刻 的 状态 x, 进行 估计 的 问题 。 
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在 系统 (6.7. DP, (w) 和 {vi} 均 为 零 均值 高 斯 白 噪声 序列 , w, 的 方差 Q 为 
已 知 的 p X p HEF IEE SE BE, u, 的 方差 R, 为 已 知 的 m X m EEEN, HEA 
Rw 《k,j) 二 0,R。(k,0) 一 0,Re(k,0) 一 0。 下 面 用 正 交 投影 法 推导 最 优 预 测 各;， BI 
$u; = E[x, | zz (6.7.2) 
由 式 (6. 7. 1(a)) 可 得 . 
x = @,.;x; + > Di, Tiimi Wwe, k>j+1 (6. 7.3) 
isi 
将 此 结果 代入 式 (6. 7. 2)， 再 利用 下 次 投影 的 狂 质 , 可 得 


S= EAn D Dw laz oz] 
= E[@.,,x; [m+ [|z z; ] 


= DELx; | zz] 十 Por Ti ELwe | 2522 9958; ] (6.7.4) 


随机 向 量 集合 (wai) ,i = j 十 1,… 和 za “sz; 对 于 任意 的 & 之 j 十 1 是 互 不 相 
关 的 ,又 因为 两 者 都 是 随机 向 量 ,所 以 这 两 个 向 量 集合 必然 是 相互 独立 的 。 考 虑 到 
{Wi}, 二 0,1,… 具有 零 均值 , 故 


E[w | 21322302] 一 0 一 7 十 1 十 2 (6.7. 5) 
由 式 (6. 7. 4) 得 
$; = DELx; | mi] = DR (6. 7. 6) 
ACG. 7. 6) 即 为 最 优 预测 a 的 表达 式 。 
下 面 推导 预测 误差 的 协 方差 矩阵 。 
预测 误差 可 表示 为 


一 Oj 


k 
= Dx; + 2 To — Det, 


= @,.,#, + or aW (6.7. 7) 
显然 , Xu G = j1, j H2) 为 零 均值 高 斯 序列 。 预测 误差 方差 阵 Pa; 应 
Pij;= E[ x, £, ] 
k k 
SEL (Out; + D earaawa)(@,z, + DO, rawa) ] (6.7. 8) 
= =m 


由 于 
R. Gkj)=0,k2>; 
故 式 (6. 7. 8) 可 以 写 为 
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k 
Paj = DELIT ]OL + 27 Dr Tiu iE[w. aw nD (6.7.9) 
i=;+1 
由 于 E[ x,zT] = P, Eww] = 0O- ,最 后 得 到 预测 误差 方差 阵 Pu 为 


Pa; = ©, POl; + > DT iQ I TT BD. (6.7.10) 
i=jtl 
下 面 将 去 掉 式 (6. 7. 10) 中 的 求 和 号 ,将 预测 误差 方差 阵 Pui 表达 为 更 简洁 的 
形式 。 
由 式 (6.7.7) 知 


n 
Xu = Dajt + D S, T. we 
i= 
= 
= Dura Dray + DisT We + 27 G.T. we 
— 
ka 
= Bm Beaji Hra Wea + Dr J Oi, Ti we 
jH 


tl 
= Orma [Ot + > Be, Ti we a] + Tee We 
= 


= @,—i Te + Th We (6.7.11) 
可 见 , Yj 不 仅 是 零 均 值 高 斯 白 噪声 序列 , 而且 具 有 马尔 可 夫 性 质 。 下 面 利用 
式 (6.7. 11) 求 预测 误差 方差 阵 Pu 。 
Puj= Enti] 
= E[(@B Xu; HDi Wea) Boe 十 Feiwei)T7] (6.7.12) 
由 于 EL mwh] = 0, 故 可 以 将 式 (6. 7. 12) 写 为 
Pu = Drea Peijl +T, uQ IL, (6.7.13) 
式 (6. 7. 13) 为 预测 误差 方差 阵 Pi, 的 另 一 种 表达 形式 。 
式 (6. 7. 6) 和 式 (6. 7. 13) 即 为 最 优 预 测 估计 及 估计 误差 方差 阵 的 计算 公式 。 其 
Po $, K, Pij Pam 的 计算 公式 与 6. 2 节 的 相同 。 


6.7.2 线性 离散 系统 的 最 优 平 滑 


所 谓 随机 线性 离散 系统 的 最 优 平滑 问题 ,就 是 在 给 定 的 假设 条 件 下 ,根据 观测 
数据 a ,zo ，,… ,zi， 对 系统 在 j(j 二 ) 时 刻 的 状态 z, 进行 估计 的 问题 。 根 据 和 j 
具体 的 变化 情况 ,最 优 平滑 分 为 如 下 三 类 。 

l. 国定 点 平滑 

令 玫 一 [am 本 为 & 时 刻 所 获得 所 有 的 观测 值 组 成 的 向 量 。 利 用 甩 估 
计 0~k 一 1 时 刻 中 某 个 固定 时 刻 ; 状态 向 量 x; 的 平滑 , 称 为 固定 点 平滑 。 平 滑 的 输 
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出 为 名 hy8lrtay…。 固 定点 平滑 常用 于 对 某 项 实验 或 某 个 过 程 中 某 一 时 刻 的 状态 
估计 ,如 利用 观测 人 造 卫 星 轨道 的 数据 估计 其 进入 轨道 时 的 初始 状态 。 

2. 固定 区 间 平滑 

利用 固定 的 时 间 区 间 [0,M] 中 所 得 到 的 素 有 观测 值 ZY = [zi ,za，…,zx] 估计 
这 个 区 间 中 每 个 时 刻 的 状态 (j 二 1,2,… M), 这 种 平滑 称 为 固定 区 间 平 滑 。 平 滑 
的 输出 为 名 lw。 固定 区 间 平 滑 常用 在 惯性 导航 系统 中 。 

3. 固定 沾 后 平滑 

AI Zt 估计 一 NN 时 刻 的 状态 xn，,NN 为 某 个 确定 得 到 固定 滞后 值 ,这 种 平滑 
称 为 固定 滞后 平滑 。 平 滑 的 输出 为 enuk = N,N 十 1,…)。 固定 滞 后 平滑 属于 一 
种 在 线 估计 方法 ,只 是 估计 的 时 间 有 延迟 而 已 。 固 定 滞后 平滑 多 用 于 通信 系统 中 。 

在 此 只 给 出 固定 点 平滑 方程 。 下 面 利用 卡尔 曼 滤波 基本 方程 和 扩充 状态 变量 
的 方法 推导 固定 点 平滑 方程 。 

设 系统 的 状态 方程 和 观测 方程 如 式 (6. 7. 1(a)) 及 式 (6.7. 1R. WRA j 
表示 固定 时 刻 , 则 固定 点 平滑 就 是 估计 Ck > j). 

现在 在 原 有 的 状态 向 量 中 增加 一 个 新 的 状态 变量 x , 其 递 推 方程 为 

nn = (k > j) (6.7.14) 
IMEA x; = x;, WJ 
xk = x, 

这 说 明 增加 的 这 个 状态 虽然 在 形式 上 有 线性 递 推 关系 ,但 实际 上 它 就 是 固定 点 的 状 
# x; , * k AR k + 1 时 刻 状态 x; 的 预测 为 as 则 


£t = Hs 
令 Plon 表示 平滑 误差 方差 阵 , 则 
Phan = pik = E[ (x; — $) (x; — $) 7] (6.7.15) 
状态 扩充 后 的 系统 和 观测 方程 为 
xa ] [Orne 0]Trx T, 
[P| [922 E E erae 


= x 
z = [LH [ra (6.7.16(b)) 
28 k = j BF 1825181318 E 1 FX: 
x; ]_ [x; 
KHE] 
将 离散 系统 卡尔 曼 一 步 预 测 基 本 方程 用 于 系统 (6. 7. 16) ,得 


pee] [2 | 
Sirija 0 ILS 
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-P ssh [aller ofa) 
= J; 十 E Jea, ofan H F k (6.7.17) 
K; = Bik 


[w [$] 
按照 式 (6. 7. 16(a)) , 增 广 后 的 状态 估计 误差 方差 阵 P8514 为 
llk hj 
e (EF a I P } 
T T T 
s. peed E qi 
ú = ne] 
1 Ilk 
仿照 一 步 预测 基本 方程 Pen 矩阵 ,得 


[2 ae [2 ls e 





式 中 
34 k = j 时 ,具有 初始 条 件 








(6.7.18) 


Parmi (Pimi) Orna 07 Tn, 
x P Pñ: ] 0 A +[ etrr 0] 
(6. 7. 19) 
考虑 到 误差 方差 矩阵 的 对 称 性 ,将 式 (6. 7. 19) 转 置 后 得 
| | 
Pi Pas 
一 [ Jes Saar 
0 TITLE . Pfam 
. x 
x [sa 1- la lm oJ] +[ arr o 
“zs (Qasa HE GÇ) —@as Pim DHE R) + Bn Piui a 
Pika (Dene — HE (K; )™) — Pia HE R" +H Pha 
T 
+ F: M (6.7.20) 


ACG. 7. 20) 误 差 方差 矩阵 各 元 素 初始 条 件 为 
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Eg Parji sa al 
P Pia Pm Pij 


因为 式 (6. 7. 17) 中 增益 矩阵 区 ] 相当 于 一 步 预 测 方程 中 的 Ki 矩阵 , 故 可 以 写 为 


区 J- [> las: Qa asam +R J” 


(6. 7. 21) 

式 (6.7. 17)、 式 (6. 7. 20) 和 式 (6. 7. 21) 为 状态 增 广 后 的 滤波 方程 。 从 形式 上 

看 ,它们 的 阶 次 增加 了 一 倍 ,但 都 可 分 解 为 n 阶 原 系统 的 滤波 方程 和 固定 平滑 方程 。 
于 是 得 固定 点 平滑 方程 为 


Sje = Sjea Riz — Hk) = ble + Kit, (6. 7. 22) 

K; = Pi HE [H,P,, Hi +R] (6. 7. 23) 

Pini = Piri [Or — K; H] (6. 7. 24) 

式 (6.7. 24) 中 ,状态 向 量 x 的 初始 值 为 bio 误差 方差 阵 Pin 的 初始 值 为 


Pais 

整个 平滑 过 程 是 :从 0 时 刻 开始 ,滤波 器 用 滤波 方程 解 算出 Pen fl K; ,并 估计 
出 名 mn ; 当 上 之 j 时 ,滤波 器 用 平滑 方程 解 算出 Pin MEKE, 从 而 解 算出 xj o 

关于 固定 点 平滑 的 几 点 说 明 ， 

(1) 平 滑 误差 方差 阵 Piro FARCE. 7. 20) 可 以 得 到 平滑 的 误差 方差 阵 为 

Pj = Pfau = Phe — Pia HE (KET 

或 P, = Pje — Pia HF (KE)T (6. 7. 25) 
按 平 滑 方程 式 (6. 7.22) ~ (6.7. 24) 的 递 推 关系 ,可 得 固定 点 j 处 平滑 值 j 的 非 递 
推 形式 的 误差 方差 矩阵 (平滑 时 刻 ; — j,j 十 1,…,k ) 为 


$. 
Pu 一 Pij — D Pin H? H)" 
= 


k 
= Pia — PAA HT (HE)T [H Ph HI +R] H: Ph)" (6.7.26) 


由 式 (6. 7. 26) 可 知 ,对 于 固定 点 7 的 平滑 误差 方差 阵 Pjl, 比 固定 点 ; 的 预测 误差 方 
ZHE Pj 要 小 , 式 (6. 7. 26) 第 二 项 就 是 误差 方差 阵 减 小 的 值 . k — ; 越 大 , 则 可 利用 
的 观测 值 越 多 ,改善 名 i 误差 方差 的 程度 也 越 大 。 

(2) 从 平滑 方程 可 以 看 出 ,平滑 增益 阵 K; 和 误差 方差 阵 Peno 与 观测 无 关 。 因 
此 ,可 以 单独 进行 运算 。 它 们 与 滤波 方程 中 的 K, 和 Pen 具有 相同 的 性 质 。 

(3) 对 于 定常 系统 , H, = H,O = @。 当 滤波 器 趋 于 稳 态 时 ，KE = K' ， 
Pius = P, 则 
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K; = Pia H" [HP,, iH! + R]: (6.7.27) 

Pia = Phi [O — K` HJ 一 五 [gr — H!K'* TJ“ (6.7. 28) 

Ps 一 五 一 LPi [HPH +RJH(P3, 1)T (6.7.29) 

对 于 定常 系统 ， 虽然 滤波 器 在 稳 态 时 也 是 定常 的 ， 但 因为 是 时 变 的 ,所 以 固定 


点 平滑 器 是 时 变 的 。 

4) 平滑 改善 估计 误差 方差 的 程度 与 Q; 和 R 有 关 , 或 者 说 与 信 品 比 有 关 。R 越 
大 ,平滑 改善 滤波 性 能 的 作用 越 小 。 如 果 系 统 噪声 大 , 则 从 以 后 的 观测 值 中 可 以 更 
多 地 改善 固定 点 状态 的 估计 ;如 果 观 测 噪声 大 , 则 以 后 的 观测 再 多 ,估计 的 改善 程度 
也 不 会 太 大 。 这 一 点 也 是 作为 是 否 采 用 平滑 技术 改善 估计 的 依据 之 一 。 

(5) 如 果 需 要 平滑 的 是 一 部 分 状态 变量 或 者 是 某 些 状态 变量 的 线性 组 合 y 有 

X = Lixa 
而 y, 的 维 数 p < n, WI| 
Br =L De = LR 

平滑 器 的 阶 数 可 以 从 n 阶 降 到 思 阶 。 


6.8 ”卡尔 曼 滤波 应 用 举例 


6.8.1 卡尔 受 滤波 器 在 舰 船 横 摇 运动 姿态 估计 中 的 应 用 


舰 船 在 海上 航行 时 ,在 海浪 等 干扰 作用 下 将 产生 摇 荡 运动 ,其 中 运动 幅度 较 大 
的 是 横 摇 运 动 。 如 何 根据 测量 装置 获取 的 信息 实时 精确 地 估计 和 预报 舰 船 的 运动 
姿态 ,对 于 有 效 地 进行 其 姿态 稳定 控制 及 舰 载 直 升 机 的 安全 着 舰 等 均 具有 十 分 重要 
的 工程 意义 。 

卡尔 曼 滤波 有 效 的 条 件 之 一 是 要 求 系 统 干扰 与 测量 噪声 均 为 白 噪声 。 根 据 海 
浪 理 论 , 海 浪 对 舰 船 的 干扰 为 有 色 噪 声 ,用 于 测量 舰 船 横 揪 运动 角速度 的 陀螺 的 测 
量 噪 声 也 往往 是 有 色 品 声 。 

首先 ,根据 舰 船 的 固有 属性 和 海浪 干扰 为 一 有 限 频 率 带宽 的 随机 过 程 的 特点 ， 
设计 卡尔 曼 次 优 滤波 器 ,然后 用 等 效 的 高 斯 -马尔 可 夫 序列 模型 对 海浪 干扰 进行 白化 
处 理 ,利用 成 型 滤波 器 对 测量 噪声 进行 等 效 变换 ,得 到 扩充 的 数学 模型 ,进而 设计 卡 
尔 曼 最 优 滤波 器 ,从 而 对 某 舰 在 几 种 海 情 上 浪 向 角 航 行 时 的 横 摇 运 动 姿态 进行 估 
计 , 并 对 预报 进行 数字 仿真 。 

1. 横 扬 运动 姿态 估计 的 次 优 估计 

根据 动力 学 原理 , 舰 船 在 海上 航行 时 的 横 播 运动 方程 为 

G) + 2vwð A) + wt) = akat) (6.8.1) 
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式 中 , 0(z) 为 船 的 横 摇 角 ; v 为 船 的 阻尼 比 ; o, 为 船 的 横 播 角 频 率 ; a, CG) 为 海浪 的 有 


效 波 倾角 。 
$: XD) =0) m=,(O = AA) 


则 得 状态 方程 为 


ol [es s Re 6s» 


将 某 舰 参数 2, = 0. 265,4 = 0.4874 代入 式 (6. 8. 2) ,将 其 离散 化 ,得 离散 状态 
方程 为 

a (k) 0.9904 0. 19427x (k—1)7 , 0. 0095 

G rA p B 0.0946 O. | @— >F B 0941 

:由 海浪 理论 可 知 , a, G) 为 一 平稳 高 斯 随机 过 程 ,其 数学 仿真 模型 为 


N . 
êo) = >) /2|” S. Coe) decos lÂnt Hen) (6. 8. 4) 
EN San 


式 中 , Sue Cwe) 为 考虑 船 宽 和 吃水 影响 及 航速 和 浪 向 的 有 效 波 倾角 遭遇 谱 , 且 有 
Salan) = —— (6. 8. 5) 


ju-D (6. 8. 3) 


式 中 , p 为 浪 向 角 ( 迎 浪 时 p = 0 )。 由 式 (6. 8. 5) 可 知 , 当 船 以 某 一 航速 和 浪 向 航行 
时 ,在 某 一 频率 o, Abs Sae Coe) 将 出 现 间断 点 。 考 虑 到 窄 频带 内 的 能 量 等 效 关系 
Su (0e) do, = Sue Cow)dw, 仿真 时 用 S..《(w)dw 代替 式 (6. 8. 4) 中 的 S.Cw) dw,。 经 均 
值 ,方差 和 谱 的 数字 仿真 检验 表明 ,这 种 方法 是 可 取 的 。 

工程 中 常用 角速度 陀螺 测量 船 的 横 播 运动 ,其 随机 测量 误差 V(z) 主要 是 由 于 陀 
螺 的 随机 漂移 所 致 ,VCz) 可 认为 是 一 个 具有 指数 相关 函数 的 平稳 高 斯 随机 过 程 , 即 











Rv(r) = Fea (6. 8. 6) 

其 功率 谱 密度 函数 为 
Se) = 1 [Reca = 1 x z (6.8.7) 

于 是 , VO 的 仿真 可 由 传递 函数 为 

G(s) = Hs (6. 8. 8) 
的 成 型 滤波 器 在 白 噪声 的 驱动 下 实现 。 

ERG. 8. 3) 中 ,如 令 
_ [aw _ [0.994 0.1942 _ fo. 0095 
XG@) = [o] T E 0946 0. oil Ë: h u] 


则 式 (6. 8. 3) 可 写 为 
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Xk) = O, XG: — 1) +Tia,(&—1) (6.8.9) 
其 测量 方程 为 
ZG) = HX (k) +V (k) (6. 8. 10) 
式 中 , H, = [0, 1]. 
由 式 (6. 8. 9) 一 (6. 8. 10) 描 述 的 系统 卡尔 曼 滤 波 器 1 为 
RG) = D Åk — 1) + KGD[ZG:) — H,@,&(k —1)] 
K(k) = P(# | k— DHI[H,P(k | k— HT +R]” 
P( | k—1) = @,P(¿ — Do +r, Qr? 
P(k) = [I— KG)H,JP(k | £—1) 
在 海浪 有 义 波 高 为 3. 8m、 航 速 为 18 节 和 浪 向 角 为 p = 90° 的 情况 下 ,采用 卡尔 
曼 滤波 器 1 对 舰 船 横 摇 的 运动 姿态 进行 估计 ,计算 机 仿真 结果 如 图 6. 4 和 图 6. 5 所 
示 , 分 别 为 船 的 横 播 角 6(z) 和 横 播 角速度 OO 的 真 值 与 估计 值 的 仿真 曲线 。 











(6. 8. 11) 
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图 6.4 9 一 90" 时 横 摇 角 真 值 与 估计 值 的 仿真 曲线 


由 仿真 结果 可 知 ,估计 误差 的 均值 和 方差 都 很 大 ,表明 卡尔 曼 滤波 器 1 的 性 能 较 
差 , 出 现 这 种 情况 的 主要 原因 是 海浪 干扰 和 测量 噪声 均 为 有 色 噪 声 。 经 分 析 发 现 ， 
测量 噪声 为 有 色 噪 声 是 主要 原因 。 由 于 卡尔 曼 滤波 器 的 无 偏 性 和 最 优 性 是 以 系统 
干扰 与 测量 噪声 均 为 白 噪声 为 前 提 , 因此 这 里 有 必要 对 测量 噪声 V(z) 进行 白化 
处 理 。 I 

由 式 (6. 8. 8) 可 得 


VG) +8V(O = VBT £) (6. 8. 12) 
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图 6.5 9 一 90" 时 横 摇 角 速度 真 值 与 估计 值 的 仿真 曲线 


式 中 , E) 为 零 均 值 的 高 斯 白 噪 声 随机 过 程 ,对 式 (6. 8. 12) 进 行 离散 化 ,得 
VG) = VG —1) +&k— 1) (6.8.13) 
经 计算 , By = 0. 9998, 
虽然 海浪 干扰 为 有 色 噪 声 ,但 由 于 船体 的 横 揪 运动 姿态 对 海浪 干扰 的 传递 函数 
近似 为 一 个 二 阶 振荡 环节 ,因此 具有 高 频 滤波 作用 ,而 海浪 为 一 个 具有 有 限 带 宽 非 
有 理 谱 平稳 随机 过 程 , 于 是 在 船 的 通 频带 内 ,将 海浪 于 扰 视 为 一 个 具有 有 限 带宽 的 
白 品 声 过 程 是 可 以 接受 的 。 基 于 上 述 分 析 ,考虑 式 (6. 8. 3) 和 式 (6. 8. 13) ,得 到 VCD) 





经 白化 处 理 的 状态 扩充 的 系统 数学 模型 为 
= (k) 0.9904 0.1942 0 TrmGk—1] [0.0095 0 
=o = Ë 0946 0.9400 0 | ee- Ë 0941 | [es 
6 一 1) 
VO) 0 0 0.9998] Lv 一 TD) 0 1 
(6. 8. 14) 
Á: . 
z, (kY 0.9904 0.1942 0 .0095 0 
XG) 一 É w! ,BD = Ë 0.0946 0.9400 0 J" = Ë 0941 i 
VE) 0 0 0.999 0 
则 式 (6. 8. 14) 可 写 为 
XG) = Xk —1) +a (k— 1) (6. 8. 15) 
其 测量 方程 为 
ZG) = H,XG) (6.8.16) 


At, B, = [0 1 1 
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由 式 (6. 8. 15) 一 式 (6. 8. 16) 描 述 的 系统 卡尔 曼 滤波 器 2 为 
R) = @,KG — 1) HKU) 一 M0R — 1)] 
K(k) = P(& | k— DHZ[H,P(k& | k— DAI 
P(& | k—1) = @,P(¿ — DO + rrF 
P(k) = [I— KGOH,JPG( | £ —1) 
在 海浪 有 义 波 高 为 3. 8m、, 航 速 为 18 节 的 条 件 下 ,在 浪 向 角 p= 90° 时 利用 卡尔 
曼 滤波 器 2 进行 横 播 运动 姿态 估计 的 仿真 。 估 计 误 差 XG) = XG) — KG) 的 均值 
和 方差 分 别 为 
ECCk)] = [一 0. 0252 一 0.0132]7 Var[¥k)] = [0. 02260. 00377" 
图 6.6 和 图 6. 7 分 别 为 船 的 横 播 角 0(t) 和 横 播 角速度 OO) 的 真 值 与 估计 值 的 仿真 
曲线 。 由 仿真 结果 可 知 ,在 对 测量 噪声 进行 白化 处 理 后 ,卡尔 曼 滤 波 器 2 的 性 能 比 卡 
尔 曼 滤波 器 1 有 了 明显 的 提高 ,滤波 不 再 有 发散 的 趋势 ,估计 误差 可 以 接受 。 为 了 进 
一 步 提高 滤波 器 的 性 能 ,下 面 再 次 优化 系统 模型 ,即将 系统 干扰 也 进行 白化 处 理 。 


(6. 8. 17) 
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利用 式 (6. 8. 17) 进 行 横 播 运动 姿态 估计 时 ,是 将 海浪 于 扰 看 作 是 白 噪 声 进行 
的 。 当 海浪 波 面 采用 PM 谱 时 ,海浪 波 面 倾角 ao C) 的 能 量 谱 密度 函数 为 


S. (w) = e 8 (6.8.18) 
其 相关 函数 为 
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图 6.7 9 一 90" 时 横 摇 角 速度 真 值 与 估计 值 的 仿真 曲线 


to 
及 (r) = f Su (wo)cosurdw (6. 8. 19) 


BR 4 z Z 0 BP, Rue(r) Z 0, 即 此 时 的 wm(z 是 一 个 相关 的 有 色 随 机 过 程 。 为 了 获 
得 最 优 估计 ,需要 对 海浪 干扰 进行 白化 处 理 , 本 例 采用 一 阶 高 斯 一 马尔 可 夫 序 列 
W, k) = gW, (k —1) + (k —1) (6. 8. 20) 
对 a| G) 进行 一 阶 矩 和 二 阶 和 矩 等 效 变换 。 
由 式 (6. 8. 20) 及 高 斯 -马尔 可 夫 序 列 的 性 质 , 有 
E(W.Q)W.(k —1)) = BWE {W2 (k —1)),k = 1,2,--- 











由 于 
Pw = E{W,(k)W, (k — 1)}/E{W} (k — 1)} 


E{(Wi(R)} = E(B Wi Ck — 1) +2ØwW. (Ck — 1k — 1) + f k —1)) 








得 
E(7 一 D) = EW) — E (WE — 1)) 
再 由 a(k) 的 平稳 性 ,可 得 
EWW) 一 GT 一 于 [Socodw (6. 8. 21) 
@y = R,T) /Ż (6. 8. 22) 
ED) = —@⁄)2/T (6. 8. 23) 


经 计算 可 知 , Bw = 0. 9483, 这 样 ,由 式 (6. 8. 14) 和 式 (6. 8. 20) 得 到 a,(k) 和 V(k) 经 
白化 处 理 后 的 状态 扩充 数学 模型 为 
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=G) 0.9904 0.1942 0.095 0 jJ[mG—D 
x(k) —0.0946 0.9400 0.0941 0 z (k—1) 0 0 | 
WEI | o o 098 o |wa—- 5 |1 olleg—y 
Væ) 0 0 0 0998] | vVæ—1) 
(6. 8. 24) 
其 测量 方程 为 
Zk) =[0 1 0 1]X(k) (6. 8. 25) 
= (k) 0.9904 0.1942 0.0095 0 
= GQ) 一 0.0946 0.9400 0.0941 0 
* x= ya] o 0 0943 0 
VQ) 0 0 0 0.999 
0 
n = 1 o wae—D = [7 D] = toro n 
0 1 
则 式 (6. 8. 24) 一 式 (6. 8. 25) 可 写 为 
XG) = OX — 1) +DT,WG—1) (6. 8. 26(a)) 
ZG) = H; X (k) (6.8. 26(b)) 
对 应 式 (6. 8. 26) 描 述 系统 的 卡尔 曼 滤波 器 3 为 
KQ) = DX (k — 1) KARLZE) — H0: Rk — 1)] 
K(k) = P(k | k — DHI[H,P(k | 一 1) HT EA 


P(¿ | k—1) = @,PG — DOT +r Or? 
P(k) = [I— KGQDH,JP(# | k—1) 
在 与 采用 卡尔 曼 滤波 器 2 进行 估计 时 同样 的 海 情 条 件 下 ,在 浪 向 角 ç — 90 时 利 
用 卡尔 紧 滤 波 器 3 进行 横 播 运动 姿态 估计 的 仿真 。 估 计 误 差 XG) = XCk) — K(k) 
的 均值 和 方差 分 别 为 
E[XG)J= [一 0. 0060 0. 0017]F Var[ 充 (8)] = [0.0032 o. 0007J" 
图 6. 8 和 图 6. 9 分 别 为 船 的 横 播 角 6(z) 和 横 摇 角 速度 OCO 的 真 值 与 估计 值 的 仿真 
曲线 。 由 仿真 结果 和 统计 结果 均 可 知 ,在 对 系统 干扰 进行 白化 处 理 后 ,卡尔 曼 滤 波 
器 3 的 性 能 比 卡尔 曼 滤波 器 2 也 有 了 明显 的 改善 ,滤波 精度 得 到 了 显著 的 提高 。 
3. 横 扬 运动 姿态 的 预报 
船舶 减 播 鳍 控制 系统 在 实际 运行 时 ,系统 的 液压 转 鱼 驱 动 系统 对 转 鱼 主 令 信号 
的 响应 总 是 存在 着 延迟 的 。 因 此 ,为 了 获得 理想 的 控制 效果 ,应 提供 一 个 精确 的 横 
播 运动 姿态 的 预报 值 。 


+ 172 最 优 估计 理论 























图 6.8 9 一 90 "时 横 摇 角 真 值 与 估计 值 的 仿真 曲线 
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图 6.9 9 一 90" 时 横 播 角 速度 真 值 与 估计 值 的 仿真 曲线 


对 于 由 式 (6. 8. 26) 描 述 的 线性 定常 系统 ,其 向 前 ! 步 的 预报 估计 方程 为 
K(k+L | b) = 6 XG) 
PHL] R) = HPO BT + DBTOTT DT 
ZG) = BRR- DHKHOLZA —HDRk—1)] — ç6.8.28) 
K(k) = P(& | #— DHI[ H, PG | k— DHI]? 
PG | k—1) = @, PG DE + r,QrT 
PG) = [I— KGQ)H,;JPG | k—1) 
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在 与 前 面 仿真 相同 的 条 件 下 ,在 计算 机 上 对 系统 式 (6. 8. 26) 进 行 仿真 ,结果 如 
图 6. 10 一 图 6.11 所 示 。 预 报 误差 XG) = XG) — XG | 有 一 1) 的 均值 和 方差 分 别 为 
ELXGDJ = [一 0. 0630. 0065]7 Var[ (J = [0. 00750. 0020]7 
可 以 看 出 ,预报 误差 的 均值 和 方差 比 最 优 估计 误差 的 均值 和 方差 大 ,但 是 误差 在 可 

以 接受 的 范围 内 。 
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图 6.10 横 播 角 真 值 与 预报 值 的 仿真 曲线 
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图 6. 11 横 播 角速度 真 值 与 预报 值 的 仿真 曲线 
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结论 及 说 明 

通过 次 优 估计 、 最 优 估计 及 预报 的 研究 和 仿真 ,可 以 得 出 以 下 结论 : 

(1) 当 测量 噪声 为 有 色 噪 声 时 ,如 不 进行 白化 处 理 , 则 卡尔 曼 滤波 器 是 不 能 有 效 
工作 的 ,主要 表现 为 估计 误差 很 大 ,甚至 使 滤波 发 散 。 

《2) 应 用 卡尔 曼 次 优 滤波 器 2 进行 横 摇 运动 姿态 估计 的 数学 模型 简单 ,在 线 计算 
量 小 ,可 达到 比较 满意 的 精度 。 进 一 步 ,可 以 采用 高 斯 一 马尔 可 夫 序 列 等 效 海浪 干 
扰 的 方法 对 其 进行 白化 处 理 和 状态 扩充 ,从 而 使 采用 卡尔 曼 滤波 器 3 的 最 优 估计 效 
果 优 于 卡尔 曼 滤波 器 2, 但 这 是 以 增加 在 线 计算 量 为 代价 的 。 实 际 应 用 时 可 视 具体 
情况 折 中 考虑 ,再 选择 设计 滤波 器 。 

(3) 采 用 卡尔 晶 滤 波 器 对 舰 船 模 扬 运动 姿态 进行 预报 的 结果 可 供 工程 实际 参考 
应 用 。 

(4) 本 例 是 以 舰 船 的 横 揪 运动 姿态 估计 为 例 进行 研究 的 ,但 其 分 析 问 题 的 思路 
与 研究 问题 的 方法 对 研究 舰 船 其 他 运动 姿态 及 考虑 六 个 自由 度 运动 之 间 耦 合影 响 
的 多 变量 的 估计 和 预报 问题 有 参考 价值 。 


68.2 卡尔 曼 滤波 器 在 全 温 式 水 要 艇 状态 最 优 估计 中 的 应 用 


现代 水 翼 艇 是 航空 技术 与 航海 技术 相 结 合 的 产物 。 与 排水 量 相 近 的 其 他 船型 
相 比 ,水 翼 艇 具有 优良 的 适 航 性 。 

水 翼 艇 的 发 展 是 两 个 学 派 努 力 的 结果 。 一 个 学 派 根据 表面 割 划 式 原理 ,用 改变 
水 翼 湿 面积 的 方法 使 艇 稳定 ; 另 一 个 学 派 研究 用 各 种 手段 控制 全 浸 式 水 经 的 攻 角 和 
升力 ,使 艇 稳定 。 以 前 苏联 为 代表 的 水 面 割 划 式 水 辟 艇 具有 结构 简单 和 经 济 可 靠 等 
优点 ,缺点 是 适应 海 情 的 能 力 有 限 , 中 等 以 上 的 海 情 下 就 无 法 工作 。 以 美国 为 代表 
的 全 漫 式 水 翼 艇 ,其 升力 面 完 全 浸 深 于 气 水 界面 以 下 ,水 翼 的 升力 不 受 水 面 起 伏 的 
影响 ,在 高 海 情 下 能 平稳 航行 ,具有 优良 的 适 航 性 ,缺点 是 这 种 艇 不 具有 自 稳 性 , 必 
须 采用 自动 控制 系统 ,造价 较 高 。 

水 翼 艇 机 航 时 ,其 升 沉 与 纵 播 ,以 及 横 摇 与 钳 播 等 运动 之 间 的 相互 影响 是 不 能 
忽略 的 。 现 代 控 制 理论 能 较 好 地 解决 这 类 多 输入 多 输出 系统 的 控制 问题 。 由 于 测 
量 仪器 不 可 避免 地 存在 着 测量 噪声 ,而 且 有 时 部 分 状态 不 能 测量 , 需 从 其 他 有 关 状 
态 中 获取 信息 。 因 此 ,为 了 对 全 浸 式 水 翼 艇 要 航 姿态 进行 有 效 的 控制 ,对 其 状态 进 
行 估计 是 非常 必要 的 。 随 着 计算 机 技术 和 现代 控制 理论 的 发 展 , 卡 尔 曼 滤波 已 被 应 
用 于 多 个 领域 ,但 是 在 某 些 情况 下 其 应 用 效果 并 不 令 人 满意 ,如 对 于 全 浸 式 水 翼 艇 
的 翼 航 状态 估计 问题 , 主要 原因 是 此 开 环 系统 具有 不 稳定 性 。 因 此 ,研究 这 种 情况 
下 如 何 更 有 效 地 利用 卡尔 曼 滤波 ,是 一 件 有 意义 的 工作 。 

1. 随机 干扰 的 研究 


水 贾 艇 在 水 上 航行 时 , 由 于 空气 的 密度 远 小 于 海水 的 密度 ,因此 空气 对 艇 的 干 
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扰 作 用 可 忽略 , 艇 所 受 的 干扰 主要 为 海浪 的 随机 干扰 。 根 据 海浪 理论 ,海浪 具有 各 
态 历经 性 和 平稳 性 , 故 可 将 海浪 干扰 的 研究 归结 为 空间 上 某 一 固定 点 的 海浪 干扰 统 
计 特 性 的 研究 ,而 空间 上 某 一 固定 点 的 海浪 可 认为 是 具有 零 均 值 的 平稳 正 态 随机 过 
程 。 于 是 ,有 引 理 如 下 。 








引 理 ” 设 空间 上 某 一 固定 点 的 海浪 干扰 {5&D，| z |< se) 为 零 均 值 平 稳 随机 
过 程 , 且 功率 谱 密度 为 S,Co) , 则 该 过 程 的 模拟 随机 过 程 &Cz) 为 
êa) 一 > Cnet (6. 8. 29) 


式 中 ， (Con = 0, 士 1, 十 2,…) 为 零 均值 互 不 相关 的 随机 变量 序列 , 即 
E(C,) =0, 下 (CCn) =0,nZm, 下 (C2) = Se(w)dw 
ol 


模拟 误差 ee(t) = EO ÊO 的 均值 和 方差 分 别 为 


m.() = Ele(0) = 0 (6. 8. 30) 
+o 
AO) = EU EOW 站 一 2 |” S,Go[1—cosG Dra 
== Saa 


(6. 8. 31) 











RP, ân = Con Homi)/20 =+ 1, E 2ye 
在 工程 应 用 中 ,通常 只 给 出 正 频率 区 间 上 的 功率 谱 密度 A2 Co) , 即 
Sw), w>0 
A? (w) = b <a (6. 8. 32) 
,. w 


于 是 ,由 引 理 推 得 工程 中 使 用 的 海浪 干扰 模拟 过 程 为 


io = >: /Ë ._ 2A (a)docos(@,z +-e,) (6.8.33) 


式 中 ， NN 为 所 取 的 随机 正弦 波 个 数 ， En 为 [0,2x] 中 均匀 分 布 的 随机 相位 。 
水 贾 艇 以 航速 V 在 海上 航行 时 ,由 于 艇 与 浪 之 间 存 在 相对 速度 , 故 海浪 对 艇 的 
干扰 作用 还 将 与 艇 速 V 及 浪 向 角 p 有 关 , 即 艇 的 运动 取决 于 遭遇 频率 o, , 即 


=w— 主 Veosp( 顺 浪 时 p=0°) (6. 8. 34) 
对 应 于 w 下 的 干扰 谱 密度 A?(w,) 为 
AC) = A? Cu) (1 — eVeosg) (6. 8. 35) 


于 是 ,海浪 干扰 模拟 过 程 为 


N 
ko= > Ë 2A Co )dwcostânt +e) (6.8. 36) 
BAN Sii 


位 于 A Co) 峰值 频率 附近 的 组 成 波 在 迭 加 中 起 主导 作用 ,为 了 使 所 模拟 的 海浪 
在 峰 频 附 近 不 丢失 更 多 的 信息 ,本 例 采 用 等 能 量 划分 频率 的 方法 模拟 海浪 。 海 浪 模 
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型 采用 PM 模 型 , 即 
A lw) = EA m + s) (6. 8. 37) 
w 
式 中 , A = 8. 1 X 10° g’ ,B = 0. 032 (g/ H.)° , H, 为 海浪 的 有 义 波 高 , g = 9. 8m/s° 
为 重力 加 速度 。 
定义 
Eco = | Sew do (6.8. 38) 
由 式 (6. 8. 37) 和 式 (6. 8. 38) 得 
Ew) = få (6. 8. 39) 
n nA ... 
因为 EG.) = HEC) = gen = 12 N+1 
所 以 n = [BA (XH) ] n= 12N+l 


将 上 述 结果 代入 式 (6. 8. 36) 得 


TE A A 
êa) = [ZEN FT st +e) (6. 8. 40) 


由 于 艇 用 传感器 的 系统 误差 可 离线 补偿 ,因此 本 例 只 考虑 传感器 的 随机 误差 ,并 认 
为 它 服从 零 均值 的 正 态 分 布 。 测 量 噪声 的 模拟 可 由 下 式 实现 , 即 
的 = MV—20 ln(m)cos2rm 
V, = /—2Zln()sin2xy 
式 中 , V, 和 V; 是 相互 独立 的 N(0,o) 分 布 的 随机 变量 , m 15 p J [0,1] 上 均匀 分 
布 的 相互 独立 的 随机 变量 , o? 为 测量 误差 方差 。 
2. 状态 估计 及 卡尔 受 滤 波 器 的 重 棒 性 研究 
全 浸 式 水 翼 艇 翼 航 时 ,其 纵向 运动 有 弱 自 稳 性 ,横向 运动 无 自 稳 性 。 因 此 ,本 例 
研究 的 是 闭环 系统 中 卡尔 曼 滤波 器 用 于 辟 航 状态 最 优 估计 问题 。 
水 贾 艇 翼 航 状态 数学 模型 为 
@X(k—1) + YUk — 1) +TWGk—1) 
ZG) = HX (k) 十 VC) 
在 纵向 平面 中 , X) = [ACE) AGO) Ok) BCk)JT,hlk) 3364935, 0(k) 
为 艇 纵 摇 角 ; UCk) = [U,G) Uy(k) 丁 ,Uk) MU ANAA ERRAR 
fü; WG) = [F (k) M,.GDT F.C) 和 JM.(k) 为 海浪 干扰 , VCE) 为 测量 噪声 。 


(6. 8. 41) 








(6. 8. 42) 


0.99 0.11 一 6.64 一 0.44 一 1.12 一 0.7 
g- | 91 0.24 一 55.68 —4.58 y= | 一 10.34 一 6.17 
0 0 1.05 0.10 | 00 一 0.02 


L0.01 0.01 0.28 0.22 0.51 —0. 15. 
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.02 —0. 0: 
0.12 — 0.87 P 1 0 让 
= H= 
F 0.00 0.01 0 0 1 O. 
.00 0.11 


在 横向 运动 中 , X) = [YQ YG çG) çG) QG) POFA, 
Pk) 和 PR) 分 别 为 横 荡 位 移 、 模 播 角 和 盘 摇 角 ; UG = [Ur k) UA(CE)]T,UR(E) 
AUA) 分 别 为 舵 角 和 副 辟 角 ; WCk) 为 干扰 向 量 , V 为 测量 噪声 。 


.00 0.18 0.59 0.27 0 —120 0.06 0.07 
0 083 5.75 240 0 —11.37 033 113 
_| o ool 101013 0 —0.03 _ |—0.02 一 0.09 
@= o 002 0.12 od 0 —0.27 = |—0.14 0.75 
0 0 0 0 10 018 0.01 O 
0 0 00 0100 0 082 0.07 0 


.7X105 —9.8>x 105 

2.3X10 —2.5X 10° 

7.4X10® —2.6X 10° 

6.4X10*, —2.2 X 10° 

4.1X10% 2,4X10 

4.0X105 2,2X105 

用 于 翼 航 时 闭环 系统 状态 估计 的 卡尔 曼 滤波 器 为 
K, = O. + WU, , +K,[Z, 一 再 (@ + WU, D)] (6.8.43(a)) 


kj 
" 
= 
I 
55n 
ooo 
omo 
ooo 
= °° 
geog 


Un =— LÅ, (6.8. 43(b)) 

K, = Pama H" (HP, H" + RR) (6. 8.43(c)) 
P, = (I— KH)Pye (6. 8. 43(d)) 

Parmi = ØP O + IQ, I” (6. 8. 43(e)) 


式 中 , Un 为 由 最 优 状 态 调节 器 确定 的 控制 规律 ,L 为 稳 态 反馈 增益 。 
应 用 卡尔 曼 滤波 器 (6. 8. 43) 对 水 翼 艇 经 航 状态 进行 最 优 估 计时 ,每 估计 一 步 都 
将 进行 大 量 的 矩阵 运算 ,为 此 有 必要 寻找 一 种 优化 算法 。PCH 艇 纵向 运动 和 横向 运 
动 均 具有 一 致 完全 能 控 和 一 致 完全 能 观 特性 , 故 该 系统 的 卡尔 曼 滤波 器 在 参数 无 误 
差 时 ,具有 渐 近 稳定 性 ,于 是 可 使 用 稳 态 卡 尔 曼 滤波 器 ,以 减 小 在 线 运算 量 ,加 快运 
算 速度 。 对 应 于 式 (6. 8. 43) , 稳 态 卡尔 曼 滤波 器 为 
£, = OR. + PU, 十 KLZ — HOR, + PO)] (6.8.44(a)) 
Um —— LÊ (6. 8. 44(b)) 
式 中 ,滤波 增益 K 可 由 式 (6. 8. 43(c)) 一 (6. 8. 43(e) ) 离 线 求 出 。 
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下 面 说 明 反馈 增益 L 的 求 取 方 法 。 根 据 线性 高 斯 二 次 型 (LQG) 理 论 , 在 性 能 
指标 
n=E{ FXOX GK) FU DRUG— 1J} (6.8.45) 
k=l 


最 小 的 条 件 下 ,其 随机 最 优 控制 规律 为 
; Uri =— LX 
RH, Le 为 反馈 增益 阵 , 即 
Le = (FRY) pr pip (6. 8. 46) 
式 中 , Pi 为 对 称 阵 ,由 下 列 黎 卡 提 差 分 方程 确定 
P; = O" {Pin — Pin W(WT Pin WHR) TY Pin) O + Q. 
| k=N—1,N—2,.,2,1 (6. 8. 47) 
Ph =Q. 
式 中 , Q. 和 及 . HIFKER , RER RIERA PERE ER USKA PEI SE , 

由 于 式 (6. 8. 47) 中 的 黎 卡 提 差 分 方程 为 倒 推 计算 ,不 适合 用 于 全 浊 式 水 楼 艇 翼 
航 姿态 的 实时 在 线 控制 。 然 而 ,该 系统 具有 完全 能 控 和 完全 能 观 性 ,根据 最 优 控制 
理论 , 当 式 (6. 8. 45) 中 求 和 上 限 N — ce 时 ,其 最 优 反馈 矩阵 L, , 收敛 于 一 个 常数 矩 
REL, 即 当 式 (6. 8. 47) 达 到 稳 态 时 根据 式 (6. 8. 46) 求 出 的 增益 。 

水 汉 艇 翼 航 时 ,由 于 航速 和 水 辟 浸 深 等 因素 的 波动 ,可 能 引起 系统 参数 的 摄 动 ， 
因此 有 必要 考查 翼 艇 的 卡尔 曼 滤 波 器 是 否 具有 重 棒 性 。PCH 艇 纵向 运动 和 横向 运 
动 在 开 环 状态 时 ,由 计算 可 知 || @ | — 1, 所 以 开 环 状态 时 卡尔 曼 滤波 器 不 具有 抗 参 
数 摄 动 的 鲁 棱 性 。 但 是 ,在 通常 情况 下 ,全 淄 式 水 艇 是 在 闭环 状态 下 航行 的 。 采 
用 LQG 控制 规律 时 ,闭环 系统 的 状态 转移 矩阵 为 G — 一 QL。 如果 系 统 的 极点 得 
到 最 佳 配置 , 即 满足 更 1G1 < 1, || G || < 1, 则 无 论 是 纵向 运动 还 是 横向 运动 ,在 
最 优 控制 下 的 闭环 系统 中 卡尔 曼 滤波 器 均 具 有 抗 参 数 摄 动 的 鲁 棒 性 。 

3. 仿真 结果 

在 计算 机 上 对 卡尔 曼 滤波 用 于 水 翼 艇 状态 的 最 优 估计 问题 进行 数字 仿真 ,仿真 
结果 见 表 6-2 和 表 6-3。 表 6-2 给 出 了 纵向 运动 在 顺 浪 (o = 0°), TÈ (o= 180) 和 
FRÈ (g = 135°), 海浪 有 义 波 高 H. 为 3. 7m A 4. 8m, 初始 条 件 为 X, = 
[2 2 1 1,8% =[0 0 0 0]7 和 P 一 I 的 条 件 下 ,采用 稳 态 卡尔 曼 滤波 进行 
状态 估计 的 仿真 结果 。 表 6. 3 中 给 出 了 横向 运动 横 浪 (p — 90° ) BHD (C p= 135°), 
海浪 有 义 波 高 瓦 ,为 3. 7m 和 4. 8m, 初 始 条 件 为 Xo 一 [1 2 5 5 1 17. = 
[0 0 0 o 0 OF HP, = 工 的 条 件 下 ,采用 稳 态 卡尔 曼 滤波 进行 状态 估计 的 仿 
真 结果 。 š 
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表 6.2 纵向 运动 状态 估计 的 仿真 结果 













































































> 
== 统计 值 Žim) K, (m/s) RO XC/s) 
条 件 a 
p=0 均值 0. 2239 0, 0001 —0, 0011 0. 0004 
H, = 3.7m 方差 0. 0304 0. 0015 0. 0008 0. 0082 
e= 均值 0. 2291 0.0001 一 0. 0014 0. 0002 
H, = 4. 8m 方差 0.0328 0.0015 0.0015 0.0143 
p= 180° 均值 0. 1180 0.0001 0.0002 0.0017 
H, = 3. 7m 方差 0.0231 0.0015 0. 0015 0. 0118 
p= 180° 均值 0. 1180 0, 0001 0, 0002 0. 0017 
H, = 4. 8m 方差 0.0240 0.0015 0.0015 0.0118 
e= 135° 均值 0. 1181 0.0001 0. 0002 0.0017 
H, = 4. 8m 方差 0.0231 0. 0016 0. 0014 0. 0191 
表 6.3 横向 运动 状态 估计 的 仿真 结果 
误差 统计 值 z ç . zo s. . 
条 件 im) | X;( m/s) | ZO | RCD | ZO | Re 
8 一 0” | 一 0. 0003 0. 0004 0. 0060 —0. 0003 0. 0057 0. 0018 
H,=3. 7m ra | 0. 0010 0.0122 0. 0032 0. 0009 0. 0002 0. 0034 
9=90° 均值 | 0. 0000 0. 0004 0. 0082 —0. 0036 | 一 0.0052 0. 0026 
H, = 4.8m 方差 | 0.0014 | 0.0368 | 0.0104 | 0.0067 | 0.0076 | 0.0007 
g= 135° 均值 0. 0001 0. 0003 0. 0089 一 0.0038 | —0. 0054 0. 0022 
H, = 4.8m 方差 0.0015 0.0368 0.0103 0. 0065 0.0073 0.0007 














结论 与 说 明 

(1) 全 温 式 水 权 艇 翼 航 状态 的 最 优 估计 采用 卡尔 曼 滤波 器 是 可 行 的 。 

(2) 该 系统 的 卡尔 曼 滤波 器 具有 渐 近 稳定 性 , 且 能 在 短 时间 内 达到 稳 态 , 故 可 采 
用 稳 态 卡尔 曼 滤波 器 ,可 节省 在 线 运 算 量 。 

(3) 研 究 结果 表明 :全 温 式 水 翼 艇 姿态 控制 闭环 系统 的 卡尔 曼 滤波 器 具有 抗 参 
数 摄 动 的 鲁 棒 性 ,使 工程 实现 成 为 可 能 。 


思 考题 


6-1 设 一 维 离散 系统 状态 方程 和 观测 方程 分 别 为 
x(k+1) = 0.5x(&) + wk) 
z(&) = x(k) +o (k) 
RP, wA) M o (k) 是 互 不 相关 的 零 均值 白 噪声 序列 ,其 统计 特性 如 下 
E[Lw(k)wG) J] = 166 ,E[o (k) o G)] = 28; 
初 值 E[x(0)] = 0,P(0|10)=1 
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观测 值 z(0) = 0,z(1) = 4,z(2) 一 2 
试 求 zQ) 的 最 优 预测 估计 值 。 
6-2 已 知 系统 模型 为 


ioi 
zk 十 D) = F HEG 
z(&) = [1 0]x@) +v Ck) 
10 0 
H Efv @)]=0,E[o (k) oTG)]=0.18;,E[z(0)]=0,Var[x(0)] = [ Š MEZO) 与 x(0) 相 


互 独立 。 观 测 数据 为 z(1) = 1.1,z(2) 一 2,z(3) 一 3. 2,z(4) = 3.8, POR k = 1,2,3,4 时 的 
2Ck | A)。 

6-3 考虑 跟踪 雷达 测量 目标 的 距离 和 方位 角 , 令 o 和 6 分 别 为 目标 的 距离 和 方位 角 , THW 
量 间隔 时 间 , 状 态 方程 可 表示 为 


Plt) T 0 PAY 0 

pltm) 0 1 0 0||pGO w C) 

Otin) 0 1 T||oG,> 0 

Cta 2. 0 0 1 Ct). W, Ct) 

RP, w fl w 为 零 均 值 随机 噪声 序列 ,方差 分 别 为 中 和 路。 雷达 测量 目标 距离 和 方位 的 方程 为 

pt.) 

n Ct) 1 0 0 OJAD] [oí a) 

Fokk ol al ON + 
Ct) 


RP, 和， 为 零 均 值 白 噪声 序列 ,方差 分 别 为 中 Moi, PUS EREN. 
64 假设 一 个 矢量 离散 随机 序列 (x) 的 状态 方程 如 下 式 


(k= B a D+ [wD 
See o dl 1 


RP, w — NC0,1) 且 为 白 蝶 声 。 观 测 方程 如 下 式 
zk)= [1 0JxCk)+v Ck) 
10 


0 a 
à i HAH k= 1,10 R P, (十 ) P C—) RR 


n~ NO,2+C DD HARMA, P 一 |[ 


的 值 。 
65 设 二 阶 系统 模型 和 标量 观测 模型 为 


z&+1) 一 Ë: (Foy 
z(&) = x(k) +o (k), Ck = 1 ~ 10) 
BAREKO 是 平稳 的 , @ 一 | 。 1]: ARE o QO 是 非 平稳 的 , 及 — 24 C— 124。 E 


mbas — |” S] Kw. 
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6-6 ” 设 一 维系 统 的 状态 方程 和 观测 方程 分 别 为 
x(k+ 1) = 2x(k) + w) 
alk) = x(k) +> Ck) 
设 wC) 和 wk) 都 是 均值 为 0 的 白 品 声 ,满足 E[w(&)] = E[o (&)] = 0,E[w(k)wG)J = 26, ， 
E[o (k) v G) ] = 18 ,ELw(k) v G)] = 0,ELx(0)] = m = 0, P(0) 一 4。 设 观测 值 x(0) = 0,z(1) 
= 4,z(2) = 3,z(8) = 2, R $G | k— D, 


67 W#£BORSJES 
k 
Ramki diwl 
xQ) 
x(k) 


BE o Q) 是 均值 为 0 的 白 噪声 序列 , E[o (k)] 一 0,E[o (k) v G)J = 0. 18y 。 设 观测 值 (0) = 100, 
z(1) 一 97.9,z(2) = 94. 4,z(3) 一 92.7。 给 定 初 值 


kokio- 1] 
RLE | k—1) REC | b). 


6-8 设 动态 过 程 的 状态 矢量 为 X = [U ], 状态 方程 和 测量 方程 分 别 为 


观测 方程 为 


z( = [0 uf Jew 


1.1 


x=, +w 


aa of 


已 知 : ELW] = 0,ELWWE] = n: Jew = 0, EVV] = 2+ C 1, P, = l; 


各 时 刻 的 滤波 器 参数 Pama Ki fl P, . 
6-9 ”研究 标量 滑动 平均 时 间 序 列 模型 


& = r, Hrm 
Rp, (r) 为 一 个 单位 方差 的 高 斯 白 噪声 序列 。 试 证 明 这 个 模型 的 最 优 一 步 预 测 器 为 
ian o= iHa a PD 


6-10 下 面 为 维 纳 滤波 理论 的 一 个 经 典 应 用 。 当 信号 与 噪声 均 具有 指数 自 相关 函数 时 ,利用 

维 纳 滤波 可 以 将 噪声 滤 除 。 假 设 噪 声 方程 为 
z(&) = s(k) +n(&) 
信号 和 噪声 为 互 不 相关 过 程 , 自 相关 函数 分 别 为 
R, 一 RER R, (r) = bei 

假设 采样 间隔 为 A 的 zz 的 采样 样本 已 知 ,并 利用 已 知 样本 来 估计 se 的 值 。 令 s) A nG) 
分 别 为 状态 向 量 的 第 一 列 和 第 二 列 ,推导 卡尔 曼 滤波 器 系数 OA) HA) OR) RA) 以 及 初始 条 
PE ECO) 和 P(0) Á z = 0 时 刻 序列 开始 )。 
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611 系统 模型 表示 为 
xU (k + 1) = xi Ck) + xe Ck) + WCR) 
x; (k + 1) = x: (k) + WCR) 
式 中 , w(k) 3933918 978 38 ARAFA, H EL w(k)wG)] = 让， 状态 的 初始 估计 值 为 20) 一 
[0,0J"。 
观测 模型 表示 为 
(k++) = x(k+1) +o (+) 
m(k+1) = n (k+1) +u G+ 1) 
AP, v1Ck) fi o (k) 是 独立 的 零 均 值 的 高 斯 白 噪声 序列 , 且 E[o G) o G)] = à; ,E[v2(k) 
va G)J] = 28; ,v1(k) o2 Ck) A w(k) 不 相关 。 已 知 测量 值 和 由 模拟 得 到 的 实际 状态 值 如 下 表 



































mta k RB z1 (k) 观测 值 z2 (k) 状态 值 z1(k) 状态 值 z k) 
0 L 0. 00000000 L 0. 00000000 
1 3. 29691969 2. 10134294 | 1.65428714 1. 65428714 
2 3, 38736515 F 0. 47540797 3. 50300702 | 1. 84871988 
3 7. 02830641 3. 17688898 5. 997852924 pi 2, 47552222 
4 9, 71212521 2, 49811140 9. 15040740 3. 17187816 
5 11. 42018315 2. 91992424 12. 50873910 3. 35833170 
6 15. 97870583 6. 17307616 16. 92192594 4. 41318684 
7 22, 06934285 L 5. 42519274 a| 21. 34483352 4. 42290758 
8 | 28.30212781 3. 05365741 25. 89335144 4. 54851792 
9 30. 44683831 5. 98051141 31, 54135330 E 5. 64800186 
10 38. 75875595 4. 51016361 36. 93605670 5. 39447034 














由 表 中 的 观测 值 估计 状态 矢量 xGk + 1) = [xm kH], kA] 的 卡尔 曼 滤波 器 ,并 且 解 
决 下 面 的 问题 : Ç 

《1) 求 出 卡尔 曼 滤 波 增益 矩阵 ,得 出 最 优 估计 x+ 1) 和 观测 矢量 z(1) ,z(2),…,z( 十 1) 之 
间 的 递 推 关系 。 

(2) 利 用 标量 框图 (不 是 矢量 框图 ) 表 示 状 态 矢量 xGk + 1) 中 元 素 x (+1) fll x G+ 1) 估计 
值 的 计算 过 程 。 

(3) 确定 状态 矢量 xC) 的 估计 值 $G | R) k = 0,1,…,10, JERIH 2 Ce | k) fil So C | 有 的 曲线 。 

(ORF k = 0,1,…,10, 在 同一 幅 图 中 画 出 真实 值 和 问题 (3) 中 确定 的 x G) 的 估计 值 。 对 于 
x (k) 重复 这 一 过 程 。 当 从 1 变 到 10 时 ,对 于 i 二 1,2, 计算 并 画 出 各 自 的 误差 立 ( 妇 — $ G | D), 

〈5) 当 & 从 II 变 到 10 时 ,通过 由 卡尔 曼 滤波 器 确定 的 状态 误差 协 方差 矩阵 画 出 E[e? (k | k) ] = 
xQ) — $ (k | yi = 1,2, 

《6) 讨 论 问题 (4) 中 的 误差 x, G) — $, Gk | k) 和 问题 (5) 中 的 方差 EL Gk | E) 之 间 的 关系 。 

6-12 二 维 空间 中 一 个 运动 物体 的 系统 模型 和 观测 模型 如 下 


= (十 1 0 0.5 07 paky .25 0 
zktD| jo 1 % 05||ma 0 0.25 [se A 
z(k+1) 00 a 0||a 1 1|bmD 


G+1). 0 0 a (k). 0 1 
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1(k+ DT] 
区 we]= Ë 0 0 °] x, (k+1) +] = 12, 
z (k + 1) 0 1 0 0J|x(k+1) vlk) 

a (k+ 1). 


式 中 , > (k) 和 x(k) 表示 时 刻 & 时 在 z 和 y 方向 上 的 位 置 ,而 z; (k) 和 zx.(k) RIRBYAY k IHE z 
和 y 方向 上 的 速度 ; a = 0. 97979589; w (k) 和 w (k) 是 零 均 值 不 相关 的 高 斯 白 噪声 序列 且 
ELw GQ), w G) ] = 48y , E[w (&),w (G) ] = 1àç ;v1(k) 和 ws(k) 是 零 均值 不 相关 的 高 斯 白 噪声 序 
列 且 E[o: Q) v: G)J] = 168, ,E[o+ (k) sv: G) J = 168 , E w Ck) w (k) ui Ck) FI va Ck) 四 者 是 
不 相关 的 。 假 设 初始 条 件 为 &(0 | 0) = [0,0,0,0]" ,PC0) = 251, 测量 值 和 由 模拟 得 到 的 实际 状 
态 值 如 下 表 。 








Bal k 观测 值 z (k) | 观测 值 = (k) | 状态 值 z Gk) | 状态 值 zz (k) | 状态 值 zs (k) | 状态 值 zs Ck) 








2 POR Eis 
12, 79067 12. 96666 6. 694718 9. 848555 12, 57683 16. 09116 
7.464684 22. 80052 12. 6678 18. 04262 11. 06058 .| 16. 35988 





1 
2 

3 20. 39026 31. 67403 17.92915 26. 11322 9.762154 15.5919 
4 22.77083 | 25.7334 | 22.21501 | 33.72115 | 7.18408 | 14.52476 
5 _ | 33. 19124 49. 1115 25. 57497 40. 93572 6. 110596 14. 04006 
6 

7 

8 

9 











— 
32. 40265 44. 7559 28. 96234 48. 3139 7. 315652 15. 18898 
33.2771 58.48168 32.47833 | 55.55404 6.600291 14.46473 
































33. 66809 | 64. 372 34. 80732 62. 22753 2. 582289 12.95716 
40.74091 67.70678 36. 00437 68. 55708 2. 582289 lB 12. 09928 
10 37.3577 78. 19464 37. 45878 74. 76478 3. 620353 12. 48703 


利用 上 述 设 定 的 模型 和 条 件 , 完 成 下 面 的 问题 : 

(1) 利 用 表 中 的 观测 值 计算 每 一 个 方向 上 的 位 置 估 计 值 [2 Ce | 所,2 Ck | k] ,以 及 速度 估计 
(B Cas Ck | A)，2 Ck | )J, 

《2) 在 同一 幅 图 上 通过 使 用 所 给 的 数据 和 估计 位 置 在 二 维 空间 中 画 出 实际 的 位 置 。 

《3) 画 出 每 一 个 位 置 的 误差 

Tilk | k) = xi (k) $ (k | k) sk = 1,2,---,10 

《4) 通 过 相应 的 误差 协 方差 矩阵 比较 每 一 点 上 = 1,2,…,10 的 误差 大 小 并 讨论 相应 的 统计 
规律 。 

《5) 画 出 在 每 一 个 方向 上 的 速度 估计 值 。 
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内 容 提 要 ”本章 针 对 卡尔 受 滤波 的 发 散 问题 ,讨论 了 若干 种 抑制 滤波 发 散 的 方 
法 。 对 于 模型 误差 导致 的 发 散 , 可 以 通过 直接 和 间接 限定 增益 的 方法 增强 新 测量 数 
据 的 作用 ,如 限定 增益 滤波 、 误 差 方差 阵 加 权 滤 波 ;可 以 增加 新 数据 的 比重 , 减 小 旧 
数据 的 比重 ,如 衰减 记忆 滤波 和 限定 记忆 滤波 ;可 以 将 模型 误差 作为 状态 的 一 部 分 
而 估计 , 即 增 广 状 态 滤波 。 对 于 计算 发 散 , 可 以 采用 平方 根 滤波 法 , 减 小 截断 误差 的 
影响 。 


7.1 滤波 的 发 散 现象 


在 理想 的 情况 下 ,卡尔 曼 滤波 得 到 的 是 无 偏 线性 最 小 方差 估计 ,而 且 随 着 测量 
数据 的 增加 ,卡尔 曼 滤波 计算 出 的 滤波 误差 方差 应 逐渐 趋 于 零 或 稳 态 值 。 但 是 ,在 
实际 应 用 中 估计 可 能 是 有 偏 的 ,估计 误差 有 时 会 大 得 超过 允许 的 范围 ,甚至 趋 于 无 
穷 ,这 种 现象 称 为 滤波 发 散 。 

卡尔 曼 滤波 发 散 可 分 为 视 在 发 散 和 真实 发 散 两 种 。 如 果 滤 波 误差 虽然 很 大 ,但 
还 是 有 界 的 , 则 是 视 在 发 散 ; 若 滤波 误差 趋 于 无 穷 大 ,使 滤波 失去 作用 , 则 是 真实 发 
散 。 这 两 种 发 散 见 图 7.1. 


实际 值 


均 方 根 轨迹 
均 方 根 轨迹 


理论 值 理论 值 


> ~ 


(e) mam (b) 真实 发 散 
图 7.1 两 类 发 散 现象 


视 在 发 散 又 具体 分 为 模型 发 散 和 数值 发 散 两 种 。 第 6 章 曾 讨 论 过 滤波 的 稳定 性 
问题 ,知道 线性 滤波 系统 的 稳定 性 与 系统 的 能 控 性 和 能 观 性 有 关 , 如 果 系统 的 数学 
模型 不 是 一 致 完全 能 控 和 一 致 完全 能 观测 的 ,那么 滤波 系统 自然 不 具有 一 致 渐 近 稳 
定性 ,滤波 必然 发 散 。 这 种 由 于 系统 的 数学 模型 使 卡尔 曼 滤波 器 不 具有 稳定 性 而 导 
致 的 滤波 发 散 称 为 模型 发 散 。 这 时 ,真实 估计 误差 值 大 于 理论 预 估 值 ,但 是 有 界 ,此 
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时 滤波 器 是 次 优 的 。 抑 制 模型 发 散 的 基本 方法 是 改变 系统 的 结构 及 参数 ,使 系统 的 
状态 完全 能 观测 。 进 一 步 讲 , 如 果 能 使 系统 在 随机 作用 下 一 致 完全 能 控 和 能 观 , 则 
可 以 从 根本 上 克服 这 种 发 散 。 数 值 发 散 是 计算 过 程 中 由 舍 信 误差 引起 的 。 由 于 计 
算 机 的 字 长 是 有 限 的 ,这 就 使 得 滤波 递 推 中 每 步 计算 都 有 截断 误差 ,可 能 使 误差 方 
差 逐 渐 失 去 正定 性 甚至 对 称 性 ,使 滤波 增益 的 计算 值 与 理论 值 的 差 越 来 越 大 ,从 而 
导致 发 散 。 抑 制 数值 发 散 的 最 基本 方法 是 采用 双 字 长 运算 ,这 样 可 以 减少 有 效 数 字 
的 损失 ,从 而 有 效 地 抑制 发 散 。 对 于 滤波 问题 来 说 ,抑制 数值 发 散 的 另 一 种 有 效 方 
法 是 在 滤波 过 程 中 以 方差 阵 的 方 根 代替 方差 进行 递 推 。 

产生 真实 发 散 的 主要 原因 是 系统 的 数学 模型 或 噪声 的 统计 特性 不 准确 ,不 能 反 
映 出 系统 真实 的 物理 过 程 。 实 际 上 ,真正 准确 的 模型 不 可 能 有 ,尤其 是 不 可 能 有 真 
正 的 线性 模型 。 造 成 模型 不 准 的 原因 很 多 ,如 对 实际 的 物理 问题 缺乏 完整 的 了 解 或 
足够 的 统计 数据 ,导致 数学 模型 与 实际 的 物理 状况 不 符合 ;虽然 对 物理 问题 有 足够 
的 了 解 ,但 是 对 模型 作 了 线性 化 近似 ,或 忽略 一 些 次 要 的 因素 和 耦合 分 量 ,或 进行 了 
降 阶 处 理 等 ;对 系统 动态 噪声 或 测量 噪声 的 统计 特性 缺乏 了 解 ,从 而 其 数值 选取 不 
合适 等 。 下 面 重点 研究 这 类 发 散 问题 的 抑制 方法 。 


7.2 限定 增益 滤波 


卡尔 曼 滤波 器 中 最 优 估计 名 是 一 步 预报 估计 与 新 息 & = x 一 Hew 的 
加 权 平均 (加 权 系 数 分 别 是 单位 矩阵 和 增益 矩阵 K, )。 因 此 ,为 了 克服 模型 误差 引 
起 的 滤波 发 散 ,就 应 该 适当 削弱 te 在 滤波 估计 中 的 作用 ,而 增加 新 息 的 作用 。 为 
此 ,可 以 在 适当 的 时 刻 终止 K 的 计算 ,保持 K 为 常 值 矩 阵 继续 计算 。 这 就 是 限定 增 
益 滤 波 的 主要 思想 。 下 面 通过 一 个 具体 的 实例 了 解 发 散 的 具体 现象 ,然后 采用 限定 


增益 的 方法 抑制 这 种 发 散 。 
例 7.1 真实 滤波 发 散 实例 。 设 一 维 离散 时 间 随机 动力 学 系统 为 
= = Xea + c = zo + ic (7.2.1) 
AP, c 为 常数 。 假 设 在 建 模 时 忽略 了 常数 c, 即 取 数学 模型 为 
= = ZHI (7.2.2) 
观测 模型 为 z = z +w 《2 


RP, w 是 零 均 值 是 方 差 为 o 的 白 噪 声 序列 ,与 zo 无 关 。 
由 式 (7. 3. 2) 一 (7. 3. 3) 可 知 
®=1,H=1,r = 1,Q; = 0,R, = 
在 没有 掌握 初始 状态 任何 验 前 统计 知识 的 条 件 下 , 取 初 始 值 为 Boo = 0, Poo = co, 
利用 第 6 章 给 出 的 卡尔 曼 滤波 公式 可 得 以 下 结果 
=a = Oi = $, (7.2. 4) 
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Pia = OPD + Q, = P, (7.2. 5) 
Pa = [Pi HHR PHT’ 


[Pa + 去 ] = [Phn] 


S = 
ka: [P ka T k 
Kin = P+ H'[HP,, u HT +R,] 


E (7.2. 7) 
-*[$+e] -rh 


Benien = Di + K, [zrn — HOD, ] 
= (1 — Ko) H Kenen (7. 2. 8) 


-2 








(7. 2. 6) 





同 理 


lk 一 £—1e, +i 


k 
因此 有 


fenn 一 Tita +a 二 zen] 
， 令 &= 二 一 2,…,0, 以 此 类 推 ,最 后 可 得 


k 


fenn = £ zH 27 (7.2.9) 


RP, z, 是 对 真实 随机 动力 学 系统 的 测量 值 。 将 式 (7. 2. 1) 代 入 式 (7. 2. 3), 可 得 真 


实 观 测 方程 为 
r, = x, + = Xo + kc + (7.2.10) 


将 式 (7. 2. 10) 代 和 人 式 (7. 2.9) ,得 滤波 估 值 为 
raile = Xo +H, trha v: 


同 理 有 tu = xs +Ë + i» (7.2.11) 
将 式 (7. 2..D) 与 式 (7.2. s OS ¿z 

Xa, = x — $t = El 125 v (7.2.12) 
因此 ,真实 的 滤波 误差 方差 为 


Elens] = e+ (7.2.13) 
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参考 式 (7. 2. 6), 4 k — co 时 ,虽然 P,, — 0, 但 是 ELi] — ce。 这 就 说 明 
滤波 出 现 了 发 散 ,而 且 是 真实 发 散 。 

造成 上 述 滤波 发 散 的 原因 似乎 是 由 于 建 模 时 忽略 了 常数 c。 但 事实 上 ,即使 在 模 
型 中 考虑 了 常数 ,如 果 取 值 不 精确 ,也 仍然 会 出 现 发 散 现 象 。 例 如 , 设 模型 取 为 

x= Xn +d (dc) 
而 其 他 条 件 不 变 , 则 得 
k—1 
2 











J4 
(Ce 一 四 一 去 2 v 
ELxueh] = (3 (ec 一 六 ?十 于 


k 

28 k — co 时 ,仍然 有 EL zu zh, ] — co, 

由 于 ECan ) 在 递 推 滤波 过 程 中 不 被 计算 ,所 以 滤波 真实 发 散 的 现象 很 难 被 发 
现 。 实 际 上 ,上 例 发 散 的 直接 原因 在 于 ,随时 间 & HRK, Pa 趋 于 零 的 速度 太 快 ,从 
而 使 增益 系数 K, 随 着 k 的 增长 而 迅速 减 小 。 从 卡尔 曼 滤波 方程 

$ = $i HKC — Hisia] = [I H, ium +K, 

可 知 ,新 数据 对 滤波 的 作用 会 随 着 增益 系数 K, 的 减 小 而 越 来 越 小 ,直到 最 后 失去 作 
用 ,使 滤波 与 测量 数据 相 分 离 ,造成 数据 饱和 ,导致 滤波 发 散 。 

从 上 述 分 析 可 知 ,克服 上 例 发 散 的 简单 方法 是 ,限制 K, 减 小 , 即 在 M 个 测量 之 
后 ,对 后 面 所 有 的 测量 简单 地 保持 K, 不 变 , 即 令 


1, k<M 


二 
m *>M 


X, = Xr — rje 


K = 


即 在 M 个 测量 后 , Ki 不 再 减 小 , 取 为 固定 值 十: 这 样 , 当 k 一 oo 时 ,经 计算 可 得 滤波 
均 方 误差 为 

EL Xrti] = (M 一 1)2cz 十 
这 样 就 防止 了 滤波 发 散 。 


M 的 选取 可 以 基于 以 下 考虑 :为 了 真正 起 到 滤波 作用 ,必须 使 ELXi834] 小 于 
测量 噪声 的 方差 ,于 是 得 





2 
wN (7.2.14) 


1<M<1+2 (7. 2.15) 


由 这 个 例子 可 知 , 模 型 的 选择 如 果 稍 有 差错 ,就 有 可 能 引起 滤波 发 散 。 上 面 提 
出 的 限制 滤波 增益 K, 的 下 限 就 解决 了 滤波 的 发 散 问题 。 但 是 ,这 样 的 滤波 无 论 是 对 
于 原来 的 实际 动态 系统 还 是 对 所 取 的 动态 系统 模型 而 言 ,都 已 不 再 是 最 优 的 。 如 果 
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模型 中 的 c 为 0, 则 限定 增益 后 修正 的 滤波 误差 方差 就 会 大 于 不 限定 增益 时 的 滤波 
误差 方差 。 如 果 c 不 为 0, 为 了 防止 滤波 发 散 而 付出 的 代价 还 是 值得 的 。 

这 个 例子 说 明 , 当 滤波 模型 不 准确 时 , 可 以 通过 加 大 当前 数据 的 权 值 , 减 小 老 数 
据 的 权 防止 滤波 发 散 。 下 面 的 误差 方差 加 权 法 和 衰减 记忆 滤波 都 是 在 这 个 想法 的 
基础 上 提出 的 克服 滤波 发 散 的 方法 。 


7.3 ”误差 方差 阵 加 权 滤波 


误差 方差 阵 加 权 法 的 基本 思想 是 通过 加 权 的 方法 人 为 地 增 大 滤波 误差 方差 阵 ， 
从 而 间接 地 增 大 增益 阵 , 以 抑制 真实 发 散 。 这 种 方法 又 分 为 人 为 加 权 法 和 自动 加 
权 法 。 


1. 人 为 加 权 法 
假设 线性 系统 状态 方程 及 测量 方程 为 
x, = Drai Xea + Th Wai (7.3.1(a)) 
x = Hix +, (7.3.1(b)) 
人 为 加 权 法 是 在 计算 Pu 时 ,将 Per: 人 为 提高 * 倍 , 即 
Paa = Øri Pr ii Dh +T, QT (7.3.2) 


在 上 例 中 ,用 近似 模型 进行 卡尔 曼 滤波 时 ,有 
Pu = [Pik +H'RPH]” 


Pi = Pia + 
K, = Pa H’ RE 
如 果 将 Pm 增 大 之 1 倍 , 则 有 
Parni = sP, (7.3. 3) 


Pik= Paim 十 1 
= s? Pn +° +1 
= Py HH HeH H1 (7.3.4) 
1— p 
EnTra 
Pih = s Prun +o 2 ' 
= £ tš a + £ te t tot 
= Pah too? 二 io 二 (7.3.5) 
1— rom 
w“ 


a 
SS S 
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这 里 取 Poo = co, 于 是 有 





K, = PaRi = 1 
Ty 
因而 有 
mi = 1 — 1 
limK, =1 y (7. 3. 6) 
式 (7. 3. 6) 说 明 ,增益 不 再 是 0, 从 而 避免 了 由 于 增益 为 0 而 带 来 的 滤波 发 散 问题 。 
2. 自动 加 权 法 


新 息 序列 & = z, — 2 包含 了 实际 估计 误差 的 信息 ,而 滤波 器 发 散 的 是 实际 估 
计 误 差 超过 理论 预计 值 。 因 此 ,判断 卡尔 曼 滤波 器 是 否 发 散 的 判 据 , 即 
sie, > ytr{EleeF)} (7.3.7) 
当 不 满足 式 (7. 3, 7) 时 , 则 滤波 发 散 。 式 中 为 储备 系数 OS 1) ,tr{*)} 为 矩阵 的 迹 ， 
ex 为 更 新 序列 , 即 
E= Z, = z, — Š= 
= H,x, +u — Hsr 


= Haa +w 
其 协 方差 矩阵 理论 值 为 
Elek) = HiPur HF +R, (7.3. 8) 
代入 式 (7. 3.7) ,得 发 散 判 据 为 
sls, > Ytr{ MPa HE +R,) (7. 3.9) 
H y = 1 时 ,得 滤波 的 严格 收敛 条 件 , 即 
eke, = tr(H,P,, HE +R,) 《7. 3. 10) 
或 等 价 为 
sei = H,P,, HI +R, (7. 3. 11) 
HRC. 3. 9) 成 立时 ,将 
Pari = UDr Prii Bh Hiei Qei Th (7. 3.12) 


代入 式 (7. 3. 11), 得 
sel = S,HB,@,., Prim BE i HT 
+H, Q I Hi +R, (7.3. 13) 
由 此 得 到 
S,I= [ss — HT iQ Hi —R,J 
X [Mð mP] (7.3.14) 
进而 得 到 
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S,= i [es — HT iQ, Th HE 一 及] 


* Dm Pr TT Bh Hi) (7.3.15) 
式 中 , m 为 测量 向 量 维 数 。 
这 样 就 得 到 了 由 式 (7. 3. 1) 描 述 的 系统 协 方差 阵 自动 加 权 的 卡尔 曼 滤波 器 为 


ks = Ore $u: + K,[z, — HBr trie] (7.3.16) 
Pira = HOr Priim OTi +r (7.3.17) 
K, = Pam Hi [HPna H] + RD (7. 3. 18) 

Pie = [I—K.H, JP.) (7. 3. 19) 


由 式 (7. 3. 15) 可 知 ,为 了 得 到 加 权 系数 S,, VIERE HOr Perm Dhe HT 进 
行 求 逆 运算 ,这 就 会 增加 计算 量 。 为 提高 运算 效率 ,可 以 将 式 (7. 3. 14) 改 写 为 
SHD Pr Dim H = ss — Hi aQ, TL, HE —R, (7.3.20) 
对 式 (7. 3. 20) 两 端 矩 阵 取 迹 得 
Str (HBr Pru Dim HË) = tr(gel — HT aQ IL HE —R,) 
(7.3.21) 
由 此 得 
S, tr{sek — HT. iQ Ti HI —R.) 
tr(H,@,,, P, uu Oi HI) 
这 样 就 避免 了 和 矩阵 求 逆 运算 ,从 而 显著 地 减少 计算 量 。 
常规 卡尔 曼 滤波 的 最 优 增益 矩阵 K, 是 按照 验 前 的 数据 计算 而 得 ,在 验 前 数据 不 
准确 时 ,滤波 可 能 会 发 散 。 采 用 上 面 给 出 的 自动 加 权 滤 波 方程 通过 测量 数据 和 加 权 
系数 S,, 对 K, 进行 必要 的 修正 。 如 果 估 计 误 差 增 大 , 则 sles 增 大 ,使 得 S, 也 增 大 ， 
导致 | Pum || 也 增 大 ,结果 使 得 || K, | 也 增 大 ,从 而 加 强 了 对 新 息 的 重视 程度 , 克 
服 了 滤波 发 散 。 








(7. 3. 22) 


7.4 ”衰减 记忆 滤波 


设 系统 的 状态 方程 和 观测 方程 分 别 为 
x, = Dra Xia + Ti we (7.4.1(a)) 
r, = H,x, +u, (7.4.1(b)) 


式 中 , w fll u, 都 是 均值 为 零 的 白 噪 声 序列 ，E[w] = 0,E[mw] = 0,E[ww* J = 
Q6o,E[wo 门 = Ridy ,ELwiw}] = 0, WE $(0) = ELx(0)],P(0) = Var[x(0)], 
W. 和 x(0) 不 相关 。 

衰减 记忆 滤波 法 的 思想 是 通过 对 滤波 器 中 的 方差 阵 (包括 系统 噪声 方差 .观测 
噪声 方差 和 初始 估计 误差 方差 ) 进 行 加 权 , 以 逐渐 减 小 旧 测 量 数据 的 比重 ,同时 增加 
新 数据 的 比重 , 即 衰减 滤波 器 对 有 旧 数据 的 记忆 。 
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当 滤 波 模型 不 准确 时 ,滤波 值 中 的 旧 数据 的 比重 太 大 ,新 数据 的 比重 太 小 , 常 是 
引起 滤波 发 散 的 一 个 重要 原因 。 因 此 ,逐渐 减 小 旧 数 据 的 权 , 相 应 地 增加 新 数据 的 
权 , 是 克服 滤波 发 散 的 一 个 有 效 方法 。 根 据 这 一 观点 设计 的 滤波 器 称 为 衰减 记忆 滤 
波 器 ,是 一 种 次 优 滤波 器 。 衰 减 记忆 滤波 器 可 用 指数 ee (C> 0) WARA SS> 1, 
a> 0) 加 权 。 下 面 分 别 介绍 这 两 种 方法 。 


1. 指数 ec 加 权 法 
由 卡尔 曼 滤波 器 的 最 优 增 益 矩 阵 公式 
K, = PaEERERP (7.4. 2) 
取 时 刻 & = N, 得 
Ky = PwNERRR (7. 4.3) 


考虑 时 刻 N 的 滤波 ,为 了 克服 滤波 发 散 ,应 突出 增益 Ks, 而 相应 地 减 小 时 刻 N 以 前 
的 增益 KK。 由 式 (7.4.2) 知 , K, 与 R4 成 反比 ,因此 为 了 达到 上 述 目 的 ,可 使 离 N 越 来 
越 远 的 R, 逐渐 变 大 。 例 如 采用 指数 加 权 的 方法 ,将 PC(0) ,Ri，…,Rw1 ,Rw 按 下 列 方 
式 加 权 


e P(O) e R, pe" Royo, e®™ Rya ,Ry (7.4.4) 
式 中 的 GG = 0,1,2,…) 是 适当 选取 的 正 整数 。 
采用 这 种 指数 加 权 , 就 是 将 N 以 前 测量 值 的 作用 逐渐 衰减 。 同 样 ,对 系统 噪声 
也 给 以 指数 加 权 , 即 


03° O, re Q pee, Qa ,Ons (7.4.5) 
应 用 指数 加 权 , 等 价 于 对 状态 z, 求 最 优 滤波 时 ,将 PCO) 和 N 以 前 的 噪声 方差 
QQ Qua Ri Ris Ry 分 别 用 式 (7.4. 4) 和 式 (7. 4. 5) 代 替 ,这 相当 于 又 提出 
了 一 个 新 的 模型 , 即 
XN(k) = O(k,k—1)xN(k— D +I k,k—1)w(k— 1) (7.4. 6(a)) 
z(k) = H(k)xN(k) +o Ck) (7.4.6(b)) 
AP, WCR) on Ck) AI xN(0) 互 不 相关 , 且 








Nl 





ELW WD] =0, EW k> D [WUD] = Qie" By 








EL] = o, EI GQ) [ww(DJ) = Reh bu 


E[xN(0)] = £00), Var[ xN (0)] = P(e 
对 模型 (7. 4. 1) 在 时 刻 N 的 训 减 记忆 滤波 ,就 是 模型 (7. 4. 6) 在 时 刻 N 的 最 优 
滤波 。 滤 波 方程 组 为 
ENCk | b= Bh k— DNGk—11h— 1) +K) 
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X [zG) —HGO@(k,k—1)£"Gk—1| k—1)] (7. 4.7) 
KN(k)= P“ (k | E— DHTGED[HGEDPN (k | k— DHT(k) + RY]! 
= P^ (Ck | HT (k) (RY)? (7.4.8) 
PNG | k—1)= Ølk,k—1)P^(k—1 | k—1)0"(k,k—1) 
+T(k,k— QE (k,k—1) (7.4.9) 


PNCk | k)= [I— K" (k)HCk)]P™ Ck | k— 1) 
= (PNG | DJ” +H RYT HC) y (7. 4. 10) 


Na Na 


SG Da 
RH, QË, = Q, e ,RY = Re 
初 值 为 
y 
AN(0) = £0), P~ (0) = P(0)e2G 
+ 
-Sa 
P'(k|k—1)=PN(k| k—1)e ~ 
P' Ck | D = PN(& | De Z| 
则 


a 
PNG |k—1)=P'G | k— De Q 
= 
PN(k | R) = P Ck | Ae” 
a 
PN 一 11& 一 1) = P'G—1|k— De Q 

于 是 式 (7. 4. 8) 一 (7. 4. 10) 变 为 

K” (k)= P* (k | k — DH CHOP (k | k—1)H" Ck) 十 RN 








= P" (k | k)HT Ck) CR) (7.4.11) 
P' (k | k— D= Olk,k—1)P* (k—1 | k— LDO Ck, k —1)eem 
+HIk,k— 1) I" Ck, k—1) (7.4.12) 
P“ Ck | k)= [I—K" (k) H(k)]P* (k | k—1) 
= {[P* Ck | )] HHT CRH Ck) } 1 (7. 4. 13) 
< K’ (k) = K“ (k) 


$#'G@—1|k—1D = k1 | k1) 
E Ck | &) = EN Ck | k) 
则 得 衰减 记忆 滤波 方程 为 
$ Ck | )= Bk,k— Di" (k—1|k—1)+K" (Ë) 
X[zG@) —HQD0CGkk—1)£' (k—1|k—1)] (7.4.14) 
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K* (k)= P* (k | k— DH! (RLHO)P’ (k |k — HT (k) +R J” 








= P“ @ | AR)ETCE)RE (7.4.15) 
P* (k | k— D= @k,k— DP’ (k—1 | k— DO (k k — 1)em 
+IT(k,k—1)Q I" (k, k —1) (7.4.16) 
P* Ck | k)= [I—K" (HC ]P" Ck | k—1) 
= {[P* (k | k— D] +H CRH (k) } 1 (7.4.17) 
初 值 为 
到" (0) 一 人 (0) P* (0) P(0) 
2. S 加 权 法 


将 P(0) Re 和 Qi 进行 加 权 , 而 
PY = PiS“ ,RY = RS ON = Qa SY 


则 可 得 滤波 方程 组 ,而 
fik = Orifi + K; [z — HDi $ ua] (7. 4. 18) 
K; = Pi Hi [HP in HI +R] (7.4.19) 
Pim = Ora Pima Di S+ Drm Qaim C7. 4. 20) 
Pia = [I— Ki HP (7.4.21) 
初始 值 为 





$ = Elx] =0 Pio = P3,S "= P, 
与 卡尔 曼 滤 波 基本 方程 相 比 , 式 (7. 4. 20) 多 了 一 个 因子 S. H+ S> 1, 则 有 
Pim > Pr > K, 
因此 ,当前 数据 z, 在 滤波 方程 中 的 权 加 强 了 。 又 由 于 
$ü = [I —K; HB te + Ki zs 
= [I—Ki H; Jim HK; z, 
相应 地 又 减 小 了 Ei 的 权 , 即 降低 了 旧 数 据 对 2;, 的 影响 。 


7.5 限定 记忆 滤波 


这 种 方法 是 在 计算 滤波 值 Ck | k) 时 ,只 利用 离 时刻 最 近 的 N — 1 个 观测 值 
zk 一 NN 十 1) ,zlk 一 NN 十 2),…,z《k) (其 中 ,NN 为 事先 确定 的 记忆 长 度 ) ,而 完全 截断 
xz 一 入 十 1) 以 前 的 旧 数 据 对 滤波 值 的 影响 。 

由 第 6 章 可 知 ,卡尔 曼 滤波 基本 方程 对 观测 数据 的 记忆 是 无 限 增长 的 , 即 计算 
EC | k) 时 用 到 已 有 的 全 部 观测 值 。 限 定 记忆 滤波 ,就 是 在 计算 #C& | &) 时 ,只 用 到 
离 k 最 近 的 NN 一 1 个 观测 值 z(% 一 N 十 1),z(% 一 NN 十 2),…,z(k)， 而 完全 阻止 z(k 一 
NFD 以 前 的 旧 数 据 对 滤波 值 的 影响 。 


. 1%. 最 优 估计 理论 





在 讨论 这 种 方法 之 前 ,首先 回顾 一 下 卡尔 曼 滤波 基本 方程 的 建立 过 程 : 设 要 估 
计 的 状态 变量 为 x(k), X xC) 及 其 过 去 值 共 进行 上 次 观测 z(1),z(2)，…,z(&)， 如 
图 7. 2 所 示 。 

先 由 z(1),z(2)，…z( 一 1) (这 一 组 观测 值 记 为 3") 求 出 x(&) 的 最 优 预 测 估 
HE | k—1), 再 由 观测 值 z(1),z(2),…,z(&) (这 一 组 观测 值 记 为 Zt ) 求 出 x(&) 
的 最 优 滤波 值 Ck | R) ÈC | k) 55 £G@ | k— 1) 的 关系 为 

Elk | k) = Elk | Ro—1)+ROA Ck) — HOR | k —1)] 
上 式 即 为 卡尔 曼 滤 波 的 递 推 方 程 。 下 面 在 卡尔 曼 滤波 基本 方程 的 基础 上 ,给 出 限定 
记忆 滤波 的 计算 步骤 。 


o T 为 了 确定 x(k) 的 限定 记忆 滤波 值 ,对 
ay e zk1) 1) 及 其 过 去 值 进行 观测 , 得 到 观测 值 

: E 才 ---= ah z(1),z(2)，…z(R 一 ND s z(k—1),z(k), 
xD 其 中 , z(& 一 N) — z(&) 共有 NN 十 1 个 观测 
a 值 , 记 这 组 观测 值 为 ZË v. JEE, E ZN 为 


图 7.2 Ck|k 一 1) 和 全 Ck|k) 的 关系 图 xz( 一 N) 一 z(R 一 1) 这 一 组 N 个 观测 值 , 记 
人 wh 为 zx 一 N 十 1D) 一 ze) 这 一 组 N 个 观测 值 。 根 据 Zin 可 求 得 fw (| b), R 
据 ZEN 可 求 得 EvCk | k — 1), 根据 ZË sai 可 求 得 $v C | k), 如 图 7.3 所 示 。 










2(1) 
oaa, OSEANE. E EE = SMAA-1) 
z(k-N+1) s 
; ---- šh) (a) 
Rt s | 四 
2(k) 


图 7.3 RRD en AOF x+: KORRA 3x G&|k—1) zw OR 244 KORARA 
HOR in Ck | k) FI EnC | k— D 的 递 推 关系 ,首先 求 出 $a (k | k) 与 2w( | k— 


D 的 关系 式 ,再 求 Br (& | k) 与 $s (k | k) 的 关系 式 , 最 后 由 这 两 个 关系 式 可 以 得 到 
fnk | K HI EnC) k- D 的 关系 。 


设 无 动态 噪声 的 状态 方程 和 观测 方程 为 
x(k) 一 加 (ER 一])z(E 一 1) (7.5.1) 
z(&) = HCk)x(k) +> (k) (7. 5. 2) 


RP, v O 是 均值 为 零 的 白 噪声 序列 , E[v (4) v" G)] 一 Rs 。 
针对 上 述 系 统 ,限定 记忆 滤波 方程 的 推导 过 程 如 下 所 述 。 
(DR Ënn lk | 4) H ên | k> D 的 关系 式 。 根据 
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fv(k|k—1) 一 加 (一 1D)2vCR 一 1 | k—1) (7.5.3) 
HT Zin 比 Zh 多 了 一 个 观测 值 zx(&), 因此 根据 卡尔 曼 滤波 基本 方程 有 
sa (k | R) = fn Ck | k— D HIO) — HC) fn Ck | k—1)] (7.5.4) 











式 中 
JG) = Pplk | k — DHTR) [HOPN GE | k— DHTR) HR] (7.5.5) 
P.G | k—1) = Ok, k—1)Py(k—1 | k—1)0"Ck,k—1) (7.5.6) 
Pys Ck | k)= [I — J (k)HCkY]Py Ck | k—1) 
=[PsG@ | k= 1) + H'GOR;HG0DT: (7.5.7) 
(DR fnn G | 有 与 &v( | p) 的 关系 式 。 
根据 ZË sa 可 得 x(G) 的 滤波 值 2y(k | &)，, 再 根据 Zin 可 得 x(k) 的 滤波 值 
Ryn C | k) Zin 比 Z wh 多 了 一 个 观测 值 zx( 一 N), 但 =G; — N) 不 是 x(%k) 的 观测 
值 ,而 是 x(k— N) 的 观测 值 。 为 了 建立 由 $s Ck | k) 确定 Sua Gk | k) 的 递 推 关系 , 首 
先 将 z(k — N) 转化 为 x(k) 的 观测 值 。 考 虑 到 
x(&— N) = @G — N,k)x(&) 
z(&—N)= HCE— N)x(&— N) +v (&— N) 
= HG@—N)@(k— N,k)x(k) +u (k — N) 
因此 ,可 将 HOQ — NOC — N, k) 看 作 观测 矩阵 , 则 zCk 一 N) 就 是 xC) 的 观测 值 。 




















根据 卡尔 曼 滤波 的 基本 方程 有 
nn Ck | 所 一 2v(|A) 十 JE)[z 一 N) 
—H(¿—N)@(k — N, k) n (k | #)] (7. 5. 8) 
Tk)= Prk | OTE— NEHT Ck — N)[HG — N)@(k — N,k) 
X Py Ck | DT Ck — N,k)H" (k — N) +R, NJ (7.5.9) 


Pyn Ck | = [I —JGDHG — NO — N,k)]Py Ck | k) 
= [PR Ck | O" (k — N, k) H" (k — N)REN 
XH(k—N)Øk—N,k)] (7.5. 10) 
《3) 由 前 两 个 步骤 的 结果 求 出 x(k) 的 限定 记忆 滤波 方程 。 
式 (7. 5. 4) 减 去 式 (7. 5. 8) 得 
0= fnCk | k—1) — în Ck | RD) 十 JR)[z(E) — HGQ) $s CE | k—1)] 
J()[z(R 一 N) 一 再 一 NG@(E 一 NAD)2v(R| k)] 





ERT 
vk | ) — ink | k— D= JG)[zG) — Hkn k | k—1)] 
JIOR — N) — H& — NEk — N, k) nk | k)] 
(7.5.11) 











在 上 式 右 侧 最 后 一 项 加 减 JAH — NO — N,k)SnCk | k—1), 44 
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ink | p) — ên | k— D= JO) — HGQD£s G | k—1)] 
JGƏ[zG — N) — H@— Nk —N,k) nlk | k —1)] 
HIHOH — NNER— N,RLiv Ck | k) —£ G | k—1)] 
(7.5.12) 
将 式 (7. 5. 12) 右 侧 最 后 一 项 移 至 左 侧 ,再 在 等 式 两 侧 同时 左 乘 [I — JH — 
MOR-N, hI, 44 
înCk | k) — în Ck | k—1) 
=[I—JG)H(k—N)@(k— N, OII Ok) — Hk) ên Ck | k—1)] 
~U JGDHG — ND — N, hT Ilk — N) 
一 再 (一 NO 一 NA)Sw( | k—1)] (7.5.13) 





w 
KC) = [1—] Hk — NDE— N, DTI Ck) C7. 5. 14(a)) 
Kh) = [I-J WOH — ND — N, h TI) (7. 5. 14(b)) 
把 式 (7. 5. 3) 代 入 式 (7. 5. 13) ,得 到 z(k) 的 限定 滤波 方程 >N) , 即 
n | 月 一 GE 一 DO2rR 一 1 | 一 1) 


十 KRC)[z() — HAOR —1,k)$n k —1 | 一 1)] 一 六 (OO[z( 一 ND 





H@— NOG — N,DQ(k k — Dt G —1 | k—1)] (7.5.15) 
将 式 (7. 5. 5) 和 式 (7. 5. 9) 代 入 式 (7. 5. 14) 得 
K(k) = Py (k | BHT ORE (7.5. 16(a)) 


K(k) = Pulk | OOT R— N, bH RE— NR: — (7.5.16(b)) 
比较 式 (7. 5. 7) 和 式 (7. 5. 10) 得 
PN Ck | )= O7 —1,k)PN (k —1 | k— DOR —1,k) +H" RH k) 
>O" — N, k) H" (k — NREND (k — N, k) (7.5.17) 

式 (7. 5. 15) 一 式 (7. 5. 17) 构 成 一 组 完整 的 限定 记忆 滤波 的 递 推 方程 。 

(4) 初 值 的 选取 。 

H k< 六 时 ,观测 次 数 小 于 记忆 长 度 N, 不 能 进行 限定 记忆 滤波 ,只 能 用 卡尔 曼 
滤波 基本 方程 ,从 初 值 (0 | 0) = E[x(0)],P(0 | 0) = Var[x(0)] 开始 算 到 ECN | 
N) 及 PCN | NN)。 在 计算 中 ,凡是 & 一 N 二 0 的 (一 N) #l OG; — N,k) 等 项 都 取 
为 0。 但 从 二 NN 十 1 起 ,如 果 直 接 取 $ç (N | N) = ECN | N) 作为 初 值 进行 限定 滤 
波 , 则 随后 的 滤波 值 一 直 受 到 CO | 0) 及 PO | 0) 的 影响 ,这 是 不 符合 限定 记忆 要 求 
的 。 因 此 ,应 该 避免 初 值 EC0 | o) 及 PC0 | 0) 对 $s Ck | E) Gk > N) 的 影响 。 

对 于 本 节 讨论 的 无 动态 噪声 系统 ,由 第 6 章 的 内 容 可 知 
P> CR | b) = PG | k— 1) HATOR? HC) 
PG | k—1) 一 加 (一 DPC 一 1 一 DOT 一 1) 
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利用 上 述 两 式 可 以 推出 PCk | k) 和 PC | kE | k) 递 推 关系 , 即 
PCR | k) 一 @T(0,Ë)P;1@(0,k) 十 DPG GR DHOG, P) 
= (7.5. 18) 
P> Ck | BRCR | k) = BT 0,k)P3 2O | 0) + DEGER) 


(7.5.19) 

由 卡尔 曼 滤波 基本 方程 中 的 递 推 关系 可 知 , $C | k) 受到 初 值 2(0 | 0) 及 PC0 | 

0) 的 影响 。 当 从 二 N 十 1 时 起 进入 限定 记忆 滤波 时 , 若 取 人 (N | N) = 2(N | NN)， 

则 随后 的 滤波 fv Ck | k) C > N) 将 永远 受到 LO | 0) 和 PC0 | 0) 的 影响 ,这 不 符合 

实现 限定 记忆 滤波 的 本 意 。 为 了 免除 影响 ,应 当 从 $s CN | N) 开始 ,使 其 不 依赖 &C0 

| 0) 和 P(0 | 0), 实际 上 , 若 使 估计 值 ev CN | N) 不 依赖 初始 状态 的 统计 特性 ,相当 

于 把 初始 状态 的 方差 矩阵 看 做 无 穷 大 矩阵 sol, 即 P? = 0, 3F BIR £(o | 0) = 0。 比 
较 式 (7. 5. 18) 和 式 (7. 5. 19) ,这 实际 上 相当 于 选取 


N 
P(N | N) = [XOG MEOR HOG, N] (7.5.20) 
j=l 


&vCN| N) = PwCN1 NJ[21erG NH OR DaD] (7.5.21) 
j=1 
例 7.2 假设 真实 的 状态 方程 和 观测 方程 分 别 为 


x(k) = x(k — 1) Hulk) (7.5. 22(a)) 
z(k) = x(k) +o (k) C7. 5. 22(b)) 
但 滤波 模型 错误 地 取 为 
x(k) = x(k—1) (7. 5. 23(a)) 
zk) = x(k) +u Ck) (7.5.23(b)) 


RP, o (k) 为 零 均 值 白 噪声 序列 , 且 E[o (&) o G)]= Ju。 下面 用 限定 记忆 滤波 法 
对 此 系统 进行 滤波 。 

选取 初 值 为 &(0 | 0) = 0,P(0 | 0) = ce], 设 滤波 记忆 长 度 为 N, 4 k < N E}, 
按 卡尔 曼 滤波 基本 方程 计算 得 


PA(N| N) 一 六 


N 
NIN =DD 
i=l 


按 式 (7. 5. 17) 计 算得 
PxC | k) = P(N | N) = 


N 
按 式 (7. 5. 16) 及 式 (7. 5. 15) 分 别 计算 得 
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1 


二 二 
及 一 六 ， 玉 一 六 


A 
xuwCN | N) = NAO 








N N N 
x(N+1| N D= DO HAND 90] teo- 30] 
i=l i=l i=l 
H 
=Ñ > z(i) 


k 
z | b) = Ñ 2 zDD 


=NH 


7.6 增 广 状态 滤波 


卡尔 曼 滤波 器 发 散 的 原因 之 一 是 滤波 器 所 依据 的 数学 模型 与 对 象 的 准确 模型 
之 间 的 偏差 , 称 这 种 偏差 为 动态 偏差 。 如 果 将 动态 偏差 向 量 作 为 增 广 的 状态 变量 对 
它 进行 估计 , 则 可 以 从 根本 上 解决 真实 发 散 的 问题 。 

对 于 nn 维 线性 系统 ,有 


Xe = Ora, + B... f, (7.6.1) 
Sin = 到 He (7. 6. 2) 
ziti 一 Hin Xin 十 Ver (7.6.3) 


式 中 , zt f, 和 zin 分 别 为 地 维 状态 向 量 ,9 维 动态 偏差 向 量 和 m 维 测量 向 量 ， 

Deria Bina 和 时 +. 分 别 为 xXn 维 状态 转移 矩阵, nXq 维 偏差 系数 矩阵 和 gqXg 维 偏 

差 转移 和 矩阵。 注意 , 式 (7. 6. 1) 没 有 考虑 输入 噪声 ,但 是 并 不 影响 研究 问题 的 普遍 性 。 
引入 增 广 状 态 向 量 


。 [Xn 
二 pe] (1.6.4) 
则 式 (7. 6. D~ (7. 6. 3) 改 写 为 
xia = Dart (7.6.5) 
zn = Ba +a (7.6.6) 
式 中 
Qua Bu. 
dina = [| ° g] Hin = [Hn 0] (7.6.7) 
y 
对 于 式 (7. 6.5) 和 (7. 6. 6) 描 述 的 系统 ,其 一 步 预报 估计 误差 的 协 方差 阵 为 
Piau = @;a aP; (Diaa) (7. 6. 8) 


HRCT. 6.7) 代 入 式 (7. 6. 8) ,得 
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Piia zea 
Plà Piá 
O [õe Baa JPE Pr? [Sai Baa 
-[ 0 s: il 0 Wna 
[ee 和 da 
Lo Padl PE Oas t+P BE Pi Whaa 
将 上 式 右 端 展开 ,并 令 左 右 两 端 对 应 的 元 素 相等 ,得 到 
Piin = Sy P; Ofaa +n Pr Bh a +B, P; OR +B,a P; ‘BH, 


Pra = [ 





(7.6.9) 
Piña = Gua Pr Whaa T Ba Pi Wha (7. 6.10) 
PR = W, P; DH + W, P; ‘Yh (7.6.11) 
Pihu = W... P; Whaa (7. 6. 12) 
估计 误差 Zia = xi 一 i 的 协 方差 矩阵 为 
Pi = E[ xü (2 01] 
s | Pi! P’ 
=| -~ _ =” al (17.6. 13) 
Gaai) ECfurrhs). P; PE 
式 中 ， 
x! = ECR ia) = Paa 为 xx 估计 误差 协 方差 阵 ; 
Pi? = EC f ha) = Cu, 为 fi 与 fut 的 互 协 方差 阵 ; 
PE? = EC f, £i) = Ch, A fw 与 ?IH 的 互 协 方差 阵 ; 
P: = E( f, f = Du 为 fn 的 协 方差 阵 。 
于 是 ,有 
Penu = Piia = @,, P; ‘Dh + BCmiBh, 
+ BChiDh + Beri Dina Bin. (7. 6. 14) 
Ch = Pñ, = BaCu Vhs + B+ D, WT (7.6. 15) 
Dirie = W, D i Pin. (7.6.16) 


由 Phoen = Plau — Kin Hin Pin 得 
pai Can Jo be Ck R Fg o [a EA 


CËuk Derien Chae Denni Kis Chuk Dki 
Bp 
Pinin = Pinn — Kin Hrn Peni (7.6.17) 
Cini = Crni — Kin Hen Cenie (7. 6. 18) 


Dirin = Dirie — Kêr Her Di (7.6. 19) 


。200。 最 优 估计 理论 





式 (7. 6. 17)—(7. 6. 19) 中 的 Kin 和 Kin 由 下 式 确定 
Kin = PzaHzd LHin Pia H; 十 Re 了 


Bp 
1 Pa Cinn |T HE Í Pene Crni [Hua y 
= 0 + 
[ '] l: l|! 0 ] [mn 0] alk l 0 ] Ra 
于 是 有 
Kin = PaHh [H+ PrnuH fn +R] (7. 6. 20) 
Kin 一 CHAR LHren P,asHËi + R. J> (7.6.21) 


对 于 由 式 (7. 6. 5) 和 式 (7. 6. 6) 描 述 的 状态 增 广 系统 ,其 卡尔 曼 滤 波 器 方程 为 
Kin 
Rian = Oinki + P Jian — Hin Dinas] (7. 6. 22) 


将 增 广 状 态 的 估计 展开 ,有 
$a = Deria T Ben fae Kin [zm — Hen Durkan — He Bia f uk] 
(7. 6. 23) 
Siea = Periaf s + Kin [zm — Hin Dents — He Bra f uk] 
(7. 6. 24) 
式 (7. 6. 23) ~ (7. 6. 24) 就 是 增 广 状态 进行 动态 偏差 补偿 的 卡尔 曼 滤 波 方程 。 
当 动态 偏差 的 个 数 与 原 有 系统 状态 变量 的 个 数 相 比 很 少时 ,这 种 方法 比较 有 效 。 但 
是 , 当 动态 偏差 的 个 数 接近 于 状态 变量 的 个 数 时 , 增 广 的 状态 向 量 维 数 显著 增 大 , 计 
算 量 也 增 大 ,往往 得 不 偿 失 。 滤 波 时 ,需要 根据 实际 情况 权衡 是 否 要 进行 状态 向 量 
增 广 。 
在 例 7. 1 中 ,如 果 引入 新 的 状态 变量 X, = [ze c, JY, WA ` 


X, = OX, (7.6.25) 
Z = HX, +w (7. 6. 26) 
=e =l =n o 
显然 ,xx 的 第 一 个 分 量 满足 方程 
x, = xa +c (7. 6.27) 
是 没有 任何 简化 的 方程 。 可 以 推出 对 x, 的 估计 误差 
k . 
Za => (1- Pis) (7. 6. 28) 
从 而 得 
EZ) 一 0 (7.6. 29) 
2k LD (7. 6. 30) 











Pi = Vara) = E+ DRT 
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BA jimPue = 0。 可 以 看 出 ,通过 增 广 状态 变量 进行 卡尔 曼 滤波 ,不 仅 可 以 避免 真实 


发 散 , 而 且 是 无 偏 最 小 方差 估计 。 

为 了 克服 模型 不 准确 引起 滤波 发 散 的 问题 ,除了 上 面 介 绍 的 几 种 方法 外 ,还 有 
一 种 方法 称 为 伪 随 机 噪声 法 。 伪 随机 噪声 法 就 是 通过 人 为 增 大 系统 噪声 方差 Q 间 
接 增 大 增益 矩阵 Ks ,从 而 提升 新 测量 值 在 滤波 估计 中 的 作用 。 模 型 不 准确 所 造成 
的 模型 误差 可 以 看 做 是 对 系统 的 随机 扰动 ,可 以 通过 在 模型 中 加 上 系统 噪声 或 把 原 
有 的 系统 噪声 方差 @ 加 大 , 即 用 扩大 了 的 系统 噪声 补偿 模型 误差 。 实 际 上 ,加 大 Q, 
就 是 加 大 了 Penns AMMAT Ken, 因此 它 能 使 新 测量 值 在 滤波 估计 中 的 作用 增 大 
而 从 ,有 利于 削弱 由 于 模型 不 准确 所 产生 的 不 良 影响 。 


7.7 平方 根 滤波 


前 面 介 绍 的 几 种 方法 可 以 克服 系统 模型 不 准确 或 模型 变化 引起 的 滤波 发 散 问 
题 。 有 时 ,在 系统 模型 准确 的 情况 下 ,也 可 能 使 滤波 发 散 。 这 是 由 于 计算 机 舍 人 误 
差 的 存在 ,使 滤波 误差 方差 矩阵 Pi 和 Pu 的 计算 值 失去 非 负 定性 ,甚至 是 对 称 性 ， 
从 而 导致 K 的 计算 失真 ,并 产生 发 散 现象 。 为 了 克服 由 于 计算 机 舍 人 误差 所 引起 的 
发 散 问题 ,可 采用 平方 根 滤波 方法 。 

所 谓 平 方 根 滤波 ,就 是 在 滤波 过 程 中 ,采用 误差 方差 矩阵 的 平方 根 形 式 传播 方 
差 矩 阵 , 从 而 使 方差 矩阵 在 传播 的 过 程 中 始终 保持 非 负 定 。 首 先 将 误差 方差 矩阵 作 
分 解 : Pn = SaS ka Piia = Sui Simi s 然后 在 卡尔 曼 滤波 的 基本 方程 中 ， 以 Su 的 
递 推 关系 式 代替 Pu 的 递 推 关系 式 , 则 可 以 保证 对 于 任意 时 刻 k, Pae = SaaS 是 对 
称 非 负 定 的 。 这 样 就 减 小 了 由 于 计算 误差 引起 滤波 发 散 的 可 能 性 。 

平方 根 滤波 的 关键 在 于 将 Par 分 解 为 SuxS 了 。 由 线性 代数 理论 可 知 , 任 何 一 个 
对 称 的 非 负 定 矩阵 王 可 以 分 解 为 

P = SS" (7.7.1) 

式 中 ,8 是 一 个 下 三 角 和 矩阵 , 称 为 的 平方 根 和 矩阵 。 如 果 P EEE, S 是 非 
奇异 的 。 

设 对 称 非 负 定 和 矩阵 了 为 


Pp Pe wa Pi 
po Pa Pa … Pa 
Pa Po … Pa 


则 通过 比较 元 素 法 ,可 以 平方 根 矩 阵 S 的 各 元 素 为 


= 
S= [p,— Ss (7.7.2(a)) 
各 
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0， G< 
p= Ë (7.7.2(b)) 
5 B, — S.S, G> j 

k=1 





S; 
设 系 统 方程 和 量 测 方程 为 
x, = Ora Xia + Th Wi (7. 7.3(a)) 
r, = Hx +w (7.7.3(b)) 
RP, w 和 vw 都 是 零 均值 白 噪声 , 且 相 互 独立 ,方差 阵 分 别 为 Q MR. 
下 面 介 绍 平方 根 滤波 的 Potter 算法 。 
1) 时 间 更 新 


设 Pu 和 Pr 的 下 三 角 分 解 平方 根 分 别 为 Sy 和 Se, # w 为 ! 向 量 , 记 


Sha Dim 
A =[ (7.7.4 
' la, To Si 
对 于 i 二 1,2,…,n, 有 
ai = VAP TAP 《7.7.4(b)) 
0j 一 12 一 1 
G p =% =: (7.7.4(@)) 
APAP j= i lit 2n 
AR = AP -EDAP j= it lit2 mn (7.7.4(d)) 
完成 上 述 n 步 递 推 后 ,得 n 阶 方 阵 C, 则 
Sum = CT (7.7.5) 
2) 测 量 更 新 


若 测 量 向 量 为 m 维 , 量 测 噪声 方差 阵 为 对 角 阵 , 即 
一 diag[R} Ri + R] 
则 平方 根 滤波 的 测量 更 新 可 采用 序 贯 处 理 实现 。 
设 根据 8 一 1 时 刻 的 序 贯 处 理 结果 已 获得 总 和 Suri, 则 时 刻 的 测量 更 新 序 


贯 处 理 可 按 下 述 步骤 执行 : 
取 
£ =$ SL = Su: (7.7. 6(a)) 
对 于 三 1,2,…,m, 迭代 计算 下 述 方程 
aj = (HiSP)T (7.7.6(b)) 
bi = [aiai + SIT: (7.7.6(O) 
yi = + /BRÜD ` (7.7.6(d)) 


Ki = hiStai (7.7.6(e)) 
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4i = 3 + Ki Gi — Hi, a) (7. 7.6(f)) 
Si = S — yiKi DT (7.7.6(g)) 
X j = m Bh, BJ 3849 k BIZA Sr E ER BD 
$= $a, K = Si (7.7.7) 
思 考 题 


7-1 设 系统 状态 方程 和 观测 方程 为 
nlk+D)] Fl 21rz(D] r2 
K GA Ë Ja wlt [we 
zk) 
zW) = [1 C a 
UE WA) F o (k) 都 是 零 均值 白 噪声 序列 ,上 且 互 不 相关 。E[w(k)] = E[o (k)] = 0,E[w(k)w! (&)1 
= gdy Eo Q) vt QO] = aà, 。 试 求 系统 的 能 控 性 矩阵 CCk 一 N 十 1,k) 和 能 观 性 矩阵 OC(k 一 NN 十 
1,k), 并 判断 滤波 方程 的 稳定 性 。 
7-2 设 一 维 离散 系统 的 状态 方程 和 观测 方程 如 下 
xQ) = x@&k—1) +u 
a(k) = x(k) +o Ck) 
式 中 , Y(A) 是 零 均值 的 高 斯 白 噪声 , 且 ELv(k)uG)] = 1y 。 
若 在 设计 滤波 器 时 ,数学 模型 错误 地 取 为 
24) 一 了 一 1) 
(有 = xG) +o Q) 
试 证 明 按 如 下 选取 K" (k) 可 避免 滤波 系统 发 散 。 


J+ (有 


H kEM 
K" (k) = 1 (M 为 某 选 定 的 正 整数 ) 
Me>M 
7-3 设 一 气球 以 恒定 速度 上 升 ,气球 的 实际 状态 过 程 和 观测 方程 为 

x(k) = x(k— 1) +u 

zCk) = x(k) +v Q) 
如 果 错 误 地 认为 气球 是 静止 的 ,把 气球 上 升 的 模型 取 为 

xG) = E(k— 1) 

Ck) = xQ) +D GQ) 
D) 是 零 均值 的 高 斯 白 噪声 序列 , 且 ECD (k) o (G) ] = By , E[x(0)J = m, (0), Var[z(0)] = 
P00),x(0) 5 a GQ) 不 相关 , 求 衰 减 记忆 滤波 。 
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内 容 提要 ”首先 在 忽略 控制 项 的 情况 下 ,分 别 由 离散 系统 取 极 限 的 方法 和 新 
息 推 导 法 推导 出 线性 连续 系统 的 卡尔 受 滤波 器 ;其 次 推导 出 含有 控制 项 情况 下 的 
卡尔 要 滤波 器 ;最 后 讨论 连续 系统 卡尔 受 滤波 的 稳定 性 问题 ,并 对 估计 误差 进行 
分 析 。 

通过 对 实际 的 物理 系统 进行 分 析 后 所 得 到 的 系统 模型 一 般 是 连续 型 的 。 虽 然 
在 计算 机 上 处 理 问 题 时 ,需要 先 将 连续 模型 进行 离散 化 ,但 是 离散 时 间 系 统 的 描述 
不 能 完全 代替 连续 时 间 系 统 。 例 如 ,有 时 为 了 理论 研究 等 目的 ,还 需要 得 到 连续 系 
统 模型 下 的 结果 。 第 6 章 讨论 了 离散 系统 模型 的 卡尔 曼 滤 波 问题 ,本 章 将 研究 连续 
系统 模型 下 的 卡尔 曼 滤波 问题 。 


8.1 滤波 器 的 极限 推导 法 


由 第 5 章 可 知 ,线性 连续 系统 看 作 线性 离散 系统 当 采 样 周 期 趋 于 零 时 的 极限 , 因 
此 可 以 利用 第 6 章 中 离散 系统 卡尔 曼 滤波 的 结果 推导 连续 系统 卡尔 曼 滤波 器 。 


设 线性 连续 系统 模型 为 
x(t) = Ax) + G(t)w(t) (8.1.1(a)) 
z(t) = Hx) +o (t) (8.1.1(b)) 
其 离散 化 模型 为 
Xen 一 Oraa 十 了 He (8. 1. 2(a)) 
Zin = H Xen 十 wh (8. 1. 2(b)) 


为 了 能 从 离散 系统 的 卡尔 曼 滤 波 基本 方程 得 到 连续 系统 的 卡尔 曼 滤波 方程 ,应 

首先 建立 式 (8. 1. 1) 和 式 (8. 1. 2) 的 等 效 离散 线性 系统 数学 描述 。 将 如 下 替换 关系 

x, > xG + At) Di > Dt At,t) 

x > a(t + At) Tarm > T(t At,tD 

X > x(t), H, — H(t + At) 
Pari > PG + Att) Par > PG + Att + At) 
Paia — PC,t) K > KUO + At) 

Qi = Q0)/At, Ri = RG + At) /At 

依次 代入 离散 系统 的 卡尔 曼 滤波 公式 
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$u = Drise HK Cz — Di ui) ] 
K, = P, Hi [H,P, a Hí +R, T 
Parmi = Qr Prima Di +T, iQ a IL: 
Pir = [I—K,H, Paes 
于 是 ,得 到 
HAD = DHADE) HKC + AD[z(t + At) 
—H(+ ADD + At,D4GDJ 
KG + At)= PG@ + At, t) HT + AD[HG + At) 
X PG + A HT + AD HREH Ar) /At]' 
PG + At, D= Bt Ar,tDPG + Ar, tO + At,t) 


+re+a,p LBT Ate) 


PG + Att + At) = [I— K@ + ADHG:+ APE At,t) 
将 式 (5. 3. 16) 代 入 式 (8. 1. 3), 得 
£(t+ At)= [IHAA] + KG A) H AD 





—HG+AD[I+ACG)At80) 

在 上 式 两 端 同 减 $G) 并 除 以 Az, 得 

2 十 Ab) 一 人 CD) KG + AD 

ye: AWCE) 十 A {z(t+ At) 
—HG+ AAD[I+AC(D0DA:t]J$(0)) 
对 上 式 当 At — 0 时 取 极限 ,并 记 
KO) A lim KG L AD 

于 是 ,得 Èa) = AWH) HKO) — HO)E£C)] 


(8. 1. 3) 


(8. 1.4) 


(8. 1. 5) 
(8. 1. 6) 


(8.1.7) 
(8. 1. 8) 


RG. 1. 8) 就 是 线性 连续 系统 的 卡尔 曼 最 优 滤波 方程 ,其 初始 条 件 为 &(0) = xo。 


式 (8.1.7) 中 
K()= Katan = PUHA DH + AD 


x [ace+ApPe+ansDHrC+AD 二 RE 二 | /a 


= POU + At, t) H" + At) 
X [H G +AÐDPE + At, HT ADA HRE AT 
当 At 一 0 时 ,上 式 为 
KO) = POH (DR) 
式 (8. 1. 9) 即 线性 连续 系统 的 滤波 增益 方程 。 
HRG. 3. 16) 一 (5. 3. 17) 代 入 (8. 1. 5) ,得 


(8.1.9) 
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PC 十 ADD 一 UHAOANTPU HADU HADAT +EON LLEON 


= P(t,t) +[AC(0OP(t + PC,)AT OH) +G(0Q(0G' (O at 
定义 
limP( + At,t) = P(z,t) = PE) 
再 将 式 (5. 3. 16) 一 (5. 3. 17) 代 入 式 (8. 1. 6) ,得 
PG + At, t+ A= P(t,t) +[AG)P(t, t) +P, DATE 
+GG(DQCGDG' (O JA: — Ka + AD2HG + AD)PG(, t) 
上 式 两 端 同 减 P(t,t), 并 除 以 At, 当 At — 0 时 取 极 限 , 得 


PO)= lim 了 人 十 At 十 At) — Pt,t) 
U At 


= AWP) HPHAT E) HEGOAN A —KOH APE) 
将 式 (8.1.9) 代 入 上 式 ,得 
P(t)= AWP) -+P(2)AT) +G(0OQ(OG'(DO 
—P()HT OR? OHOP) (8. 1. 10) 

式 (8. 1. 10) 为 线性 连续 系统 的 滤波 误差 方差 方程 ,也 称 为 矩阵 黎 卡 提 微 分 方程 。 

式 (8. 1. 8) 一 (8.1. 10) 组 成 线性 连续 系统 的 卡尔 曼 滤波 方程 ,其 初始 条 件 为 

£(0) = u, (0),P(0) = P,(0) 

线性 连续 系统 的 卡尔 曼 滤波 方程 概括 在 表 8. 1 中 ,线性 连续 系统 和 滤波 器 的 结构 如 
图 8.1 和 图 8. 2 所 示 。 


表 8.1 线性 连续 系统 卡尔 曼 滤 波 方程 一 览 表 























系统 模型 X(t) = AWD) GOW wt) ~ N(o,Q(D) 

测量 模型 2l) = HWX) +o (O, (O ~ NORG)) 

初始 条 件 E[x(0)] = £0,E[(x(0)— Lo) (x(0) — 20)T] = Po 

其 他 规定 R) 存在 

状态 预测 tO = ADOKO HO] 

误差 协 方差 预测 PU) = AWPU) + P(DAT( + G(OQ(DGT(O -KOHU PE) 
状态 估计 $u = alti + Ki[u — Hifa] 

误差 协 方差 传播 Pa = [I— KH,JPi-i 

卡尔 受 增益 KO) = POH (DR (D 





在 滤波 方程 (8. 1. 8) 中 , 右 侧 第 二 项 可 看 作 是 新 息 T0 = zG) -HOA 的 不 
断 反馈 校正 作用 , 即 新 息 由 卡尔 曼 滤 波 增益 KG) 加 权 后 去 驱动 系统 ,或 者 可 以 将 连 
续 系统 卡尔 曼 滤波 器 看 作 是 在 反馈 校正 信号 KOO 作用 下 的 一 个 线性 系统 。 

与 离散 线性 系统 情况 类 似 , $G) 实际 上 是 xG) Ez, = (zÇ), < r < t) ##k 
下 的 条 件 均值 , 即 $Ç | 2) = E[x(2) | z J, 而 2(z) = ELz(z) | z J, 即 它们 均 为 最 小 
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方差 估计 。 根 据 线性 最 小 方差 估计 的 正 交 投 影 性 质 ,估计 误差 正 交 于 测量 值 ,也 正 
交 于 估计 量 , 即 


3 一 让 = 
fareas W] = Eira] = o (8.1.11) 


ETZE)" 0) ] = ELZ (2T) ] 一 0 
滤波 方程 式 (8. 1. 8) 还 可 以 写 为 
£() 一 [AG — K(OH(0J$(0 + KC)z() 


此 微分 方程 的 解 为 
2O) = ytt) El) 十 j w(,OKCOz(O)dr 
RF, w(t,wo) 是 系统 (8. 1. 8) 所 描述 的 状态 转移 矩阵 。 
M 8Co) = pelto) = 0 时 ,有 
x)= Í WG DKCOzCOdr 


则 上 式 可 知 ,当初 始 状态 的 均值 为 0 时 ,连续 系统 的 卡尔 曼 滤波 估计 4(z) 可 以 表示 
为 测量 值 的 线性 变换 。 








图 8. 2 线性 连续 系统 卡尔 曼 滤波 器 结构 图 


例 8.1 某 信息 传输 系统 的 状态 方程 为 
At) =—axGt) +w(t), t>0 
式 中 , a 是 大 于 零 的 常数 ,z(0) 是 零 均值 正 态 随机 变量 ,其 方差 为 Var[z(0)] = a 
一 常数 ; z(z) 是 需要 复 现 的 有 用 标量 信号 ; w(z) 是 零 均值 平稳 正 态 白 噪声 过 程 ,与 
(0) 不 相关 ,其 方差 为 0% 一 常数 。 接 收 的 信号 为 
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z(t) = x(t) +v) 

式 中 , v(z) 是 均值 为 0, 方 差 为 2 一 常数 的 平稳 正 态 白 噪声 过 程 , 与 x(0) X wa) 都 
不 相关 ,是 由 发 送 器 的 误差 及 传播 通道 中 的 干扰 造成 的 。 

要 求 设 计 一 个 接收 器 ,使 它 能 将 信号 z(z) 从 噪声 中 最 佳 分 离 出 来 。 此 处 最 佳 是 
指 误差 TO = zG) — (0) 的 方差 最 小 。 此 系统 为 线性 的 ,可 以 采用 线性 连续 系统 
的 卡尔 曼 滤 波 器 得 到 z(t) 的 最 小 方差 估计 。 

解 由 已 知 条 件 可 得 

a) =at) + K(DO[zG) — (01 
KO) = PWE 
PG) =— aP G) — P/E H, 
初始 条 件 为 
£(0) = E[z(0)] = 0 
P(0) = Var[z(0)] = aš 

HER PU). $ PO +2aP (o; — at = 0 的 两 个 特征 根 为 B M 8 , 采用 分 

离 变量 法 可 得 








dP(b) dP(O) 
P) +2aP Ooa [PORPORA] 
1 [ dP(O dPU) ] 
A—AñLPGO)—A PŒ- 
一 此 


RH, BB = (一 a 土 ,fz +): = Catt 








因而 ,在 :之 0 时 ,有 


P(O £ K. B G; — b) -pl — B)e 
aó — Ë — (ü — B) e * 


KO = EP 
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当 滤波 达到 稳 态 , 即 上 一 < 时 ,有 
JimPCD =B = C-a + po 


limK(CD) =B =—a +y 
例 8.2 二 阶 系统 的 状态 方程 为 


s= potiho 


z(t) = [1 0J]Jx() +o(0) 

WO) 和 v(t) 都 是 一 维 的 零 均 值 白 噪声 , 且 方 差分 别 为 
Cov[w(t)w(r)] = 48t — i) 
Cov[> (t) o () J = 28t — r) 


测量 方程 为 


1 0 
E[x(0)] = 0, Var[x(0)] = P, = b al 


E wA) o (O 和 x(0) 互 不 相关 , 试 求 卡尔 曼 滤 波 方程 及 增益 ,方差 矩阵 方程 。 
解 在 此 例 中 


aope sheo = [f] no =t J 








QW) = 4, RO) = 2,x(0) = 0,P, F °] 
， 3 P= o 
由 式 (8.1.8) 一 (8.1. 10) 可 知 
iwo 一 n: eC) + KC (G) — 1 olè) ) 
0 0 


= 1p? 

KGQ) = trof] 

ñ p. L 0 0 
PG) 一 É -Po +Pc [; 


— pe) [° 9 
trof jc o]PC) 十 4 |o J 
A ro = [22 PaO] g EN Pa (D Pa) 

Palt) Pa) Baa) Pa) 
则 有 


1 1 
Boy a O Pak a _ 2Py (CD — Ph (O) Po GD — Pa OPO 


PaO POl [PaW—$PWPsD) 4i 
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即 Pu) = 2P 0) APRO, PaO =1 
户 :(D = Pa(O 一 去 Pa(OPa(D = Pa PeO 一 0 


Puls) = 4—+Ph(D,Pa(0) 一 0 


这 是 一 个 非 线 性 联 立 微分 方程 组 ,手动 求解 析 解 会 比较 麻烦 ,需要 借助 计算 机 求解 ， 
求 得 方差 PO) 后 ,得 增益 矩阵 为 
_ 1[PaGO Peg PaCo/2 
KOSZ H O Paolo)" PA 
于 是 ,得 滤波 方程 为 
P(t)/2 


to = aotig g ep 一 口 ow] 


由 本 例 可 以 看 出 ,线性 连续 系统 卡尔 曼 滤波 方程 的 求解 问题 归结 为 矩阵 黎 卡 提 
微分 方程 的 求解 问题 。 即 使 是 一 个 简单 的 二 阶 定常 系统 ,求解 矩阵 黎 卡 提 微 分 方程 
也 需要 借助 计算 机 。 


8.2 滤波 器 的 新 息 推导 法 


连续 系统 卡尔 曼 滤波 方程 的 推导 方法 ,除了 上 面 介绍 的 离散 系统 求 极限 的 方法 
以 外 ,还 可 以 用 新 息 推导 法 。 两 种 方法 虽然 都 能 得 到 同样 的 结果 ,但 是 通过 新 息 推 
导 法 不 仅 能 够 揭示 卡尔 曼 滤波 器 的 内 涵 , 而 且 能 阐明 其 特点 。 

设 线性 连续 系统 的 数学 模型 如 式 (8. 1. 1) 一 式 (8. 1. 2) 所 示 , e) 为 由 z(t) 在 
to ~ t EEKEREN zi, 得 到 的 x(z) 的 最 小 方差 估计 ,定义 

Z(t) = z(t) — HO) (8. 2. 1) 

为 新 息 过 程 。 从 定义 可 以 看 出 ,新 息 表示 新 的 测量 数据 z(t) 与 利用 以 前 所 有 数据 得 
到 的 预测 O = HOL) 之 差 , 即 Z(z) 包含 z(z) 中 新 的 成 分 。 新 息 具 有 一 个 重要 
的 性 质 : 新 息 ZO) 是 一 个 与 测量 噪声 o G) 具有 相同 统计 特性 的 白 噪声 。 

假设 式 (8. 1. 1) 和 式 (8. 1. 2) 中 初始 状态 xC) 是 均值 为 零 且 wa) 为 零 均值 的 
白 噪声 过 程 , 从 而 有 ELx(z)] = 0, 因此 可 以 假定 x(G) 的 最 优 估计 量 £(z) 是 新 息 过 
程 z(z) 的 线性 函数 , 即 可 以 用 如 下 形式 描述 


20o 一 Í y Ddr (8. 2. 2) 


其 中 , y G, r) 需要 特殊 选取 ,以 使 估计 误差 方差 最 小 。 
由 式 (8. 2. 2) 可 得 
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ELR) 27(5)] = Í Y° DELZ) ZY (o) Jde 


根据 线性 最 小 方差 估计 的 估计 误差 xG) 与 测量 zGO 的 正 交 性 可 得 
ELEC ZT Cs)] = Elx z1(s)], ww < s<: 
H z(s) 的 白 噪 声 性 质 , 可 以 得 出 


ELxWz7 9]=| y ODELE) Jd 
° 





=Í y CORO — Dde 
° 


= yG, DRG) (8.2.3) 
于 是 ,有 
¥"(t,s) = ELX) ZT) ]R? Cs) 
则 
ta) = Í E[x(D 2T(5) JR3CG) z(o)de (8. 2.4) 
ERG. 2. 4 两 侧 同 时 对 + 求 导 ,得 
AO = EOT OIR O + Í š REOT OJN Ordr 


= Efx) z! (0) JR-1 O z) +Í ELE)? JR? (z) z (z)dr 
° 


. (8.2.5) 
$ 

KO) = ELxCDzTCD]R-CD) (8.2.6) 
再 将 式 (8. 1. 1Ca)) 代 入 式 (8. 2. 5) 得 


OKOZO) +f EAW) +G()w(DJzteO)R'1(0 rCOde 
SKOTO HAOD | EKOT ORN Ordr 
kJ 


+60) J Ewo ZT(DIR (DZ dr (8.2.7) 


由 式 (8. 2. 4) 知 , 式 (8. 2. 7) , 右 端 第 二 项 等 于 A(z)#(1), 再 由 系统 干扰 wo) 与 新 息 
z) 的 相互 独立 性 知 , 式 (8. 2. 7) , 右 端的 第 三 项 等 于 0。 因 此, 式 (8. 2. 7) 等 价 于 
£G)= AWA HKO ZC) 
=A) HKO) — HG(2£(0O J (8. 2. 8) 
式 的 (8. 2. 8) 的 滤波 方程 与 式 (8. 1. 8) 的 卡尔 曼 滤波 方程 相同 。 
下 面 确定 KG), 
E[x(2)z™(2)]= E([*GO) HOJO +o aE) 
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= E[*G)xTG)H1G)] HEO T OHT O] 


= PWH") (8. 2. 9) 
式 中 , PE) = Er A]. 于 是 
KO) = PHH OR 4) (8. 2, 10) 
式 (8. 2, 10) 求 得 的 滤波 增益 矩阵 形式 与 式 (8. 1. 9 完全 相同 。 
下 面 确定 PO 的 形式 。 


HPO 求 导 , 并 利用 式 (8. 2. 10) 求 得 的 增益 矩阵 及 式 (8. 1. 11) ,再 考虑 到 zG) 
与 w(t) 和 v(t) 都 不 相关 , 则 可 以 证 明 PO) 满足 下 列 的 黎 卡 提 微 分 方程 , 即 
PO) = AHP) 十 PCDATCD) — POH OR CDECDPC) 
+G()Q()GT) (8. 2.11) 
式 (8. 2. 11) 与 上 节 推 导 的 式 (8. 2. 8) 完 全 相同 。 
至 此 ,利用 新 息 法 推导 出 了 线性 连续 系统 的 卡尔 曼 滤波 方程 ,它们 与 8. 1 节 采 用 
离散 系统 求 极限 方法 推导 出 的 结果 完全 一 致 。 
5 AGH UR QR 都 是 常数 矩阵 时 ,系统 退化 为 线性 定常 系统 , 即 
D = Ax HGW) 
z(t) = Hx) +0 G) 
系统 干扰 wO) 与 测量 误差 G) 是 平稳 的 零 均 值 不 相关 的 白 噪声 随机 过 程 , 即 
E[wGO]=0, Cov[w(O,w(r)] = Q8 Ct — r) 
E[v (2)]=0, Cov[o (0,o ()] = R8G—r) 
Cov[w(z),əo (+) ] = 0 
假定 估计 过 程 已 经 达到 稳 态 ,但 实际 上 这 是 不 可 能 的 ,但 只 要 过 去 的 观测 时 间 足 够 
长 ,使 得 所 有 动态 现象 接近 消失 , 则 可 以 认为 达到 稳 态 。 由 于 w(t) 和 vw(z) 均 为 平稳 
随机 过 程 ,并 且 估计 过 程 已 经 达到 稳 态 ,因此 这 时 线性 最 小 方差 滤波 的 黎 卡 提 微 分 
方程 中 的 PO 与 时 间 无 关 , 其 微分 户 (z) 为 0, 因 此 微分 方程 退化 为 代数 方程 , 即 
0 = AP + PA" — PHR ` HP + GQG1 
上 式 的 解 Po 即 为 卡尔 曼 滤波 器 滤波 误差 方差 阵 的 稳 态 值 。 从 而 定常 系统 的 稳 态 增 
益 阵 为 


滤波 方程 为 





K = P. H'R`: 
$a) = ASC) +K[z(t) — H£GD] 
8.3 线性 连续 系统 滤波 器 的 一 般 形 式 


假定 ” 维 线性 连续 动态 系统 和 z 维 测量 系统 方程 为 
A) = AHD xlt) + B(OuGtO 十 GCDwCt) (8.3.1). 
z(t) = H(t)xG) +v (t) (8. 3. 2) 


第 8 章 线性 连续 系统 卡尔 曼 滤波 + 213 + 





式 中 , ulz) 是 非 随机 输 和 人 的 控制 向 量 ; w(z) 是 系统 干扰 ; v G) 是 测量 误差 ,二 者 均 
为 零 均 值 白 噪 声 过 程 , 且 二 者 是 $》 相关 的 , 即 
E[wCD)wr(r] = QO — r) 
地 (2) o! (z)J = ROG — r) (8.3.3) 
E[w(z) o! (z)J = S(t)6(t—7) 
其 他 假设 条 件 与 8. 1 节 讨 论 的 线性 连续 系统 一 样 。 

可 以 采用 与 8. 1 节 相 同 的 方法 ,利用 带 有 控制 项 的 离散 系统 卡尔 曼 滤波 公式 求 
得 式 (8. 3. DARC. 3. 2) 描 述 系统 的 最 优 滤波 。 为 此 ,首先 建立 与 式 (8. 3. 1) 及 
(8. 3. 2) 等 效 的 线性 离散 系统 的 数学 模型 , 即 

xG + At) = @G + At tx) + WG + At Dul) 十 FTCG 十 AltDw (0 
(8.3.4) 
z+ At) = HGt + At2yxG + At) + (+A) (8.3.5) 
式 中 


POH Ar) = BOA + OA) (8. 3. 6) 
TUH Att) = GHA HOA) 
(WG) UCE) st = to +kAnk = 0,1,2,-..) ERINES BERAE ERRE , FEN 2 
矩阵 分 别 为 


feta 一 工 T4A(CDAL 十 OCAi) 


CovLw CD) w e] = LLa, 
Cov[v (2) ,v0)] = Bs, (8.3.7) 


Cov[w(D,m(oD] = SOs, 





其 中 , t = to +kAt,t = to +jAtsksj = 0,1,25. 
现在 根据 第 6 章 中 线性 离散 系统 的 滤波 方程 建立 等 效 线性 离散 系统 的 滤波 方 
程 。 将 下 列 代 换 关 系 
x, — x(t + At) ,Di — OC + At,t) 
Za > z(t + At), Piri > W(t + At,t) 
Xea > X(t) Term >T At,t) 
Zei > z(t), H; > HG + At) 
Ul > ult), Jei — JG) 
Pi > PGt,t),Q, 1 = Q0) /A 
Para > Pe + At,t) Rei = RC) /At 
P, > PO + At,t+ At) Sii = SGD /Ar 
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K, > K+ At) 


依次 代入 离散 卡尔 曼 滤波 公式 (6. 3. 4(a)) 一 (6. 3. 4(e)) ,得 
(t+ AD= $G + At | D +KG-+ AD[zG + AD 


HOH AD£G—+ A:/t)] (8.3.8(a)) 
EH At | D= OGHA, LE) + Wt At, tult) 
+J(O[zG) — HG)$£G)] (8.3. 8(b)) 


JO)= PG + Att) SOR (a 


= PC 十 At,DSCGDR-CD) (8.3. 8(©)) 
KG 二 AD) 一 PG + ADH G+ AD[HG + AD 
XPUHAGOH GHA) +RG- A)/A]” (8.3.8Cd)) 
POH Att) = [OG + At, -JOHO JPG NTD Att) — JOHA] 
ratane Krat ano Je) RBT) 8.3.80) 
PC 十 AD) = [IT 一 KG 十 ADHC 十 AD]PGC 二 AD “ (8.3.8(D) 
将 式 (8. 3. 8(d)) 两 端 除 Az, 然后 求 At — 0 时 的 极限 ,得 
KO = lim Kü L AD) _ limP 十 Ab,DHrG 十 AD) 
Amo At ze0 





XLECG 十 ADPG 十 At;DHTCL 二 ADAL 十 RE 十 Ab) 二 :At 
At 


= PWH (DR) (8. 3. 9) 
将 式 (8. 3. 6) 及 式 (8, 3. 8(b)) 代 入 式 (8. 3. 8(a)), 且 忽略 OCA), 得 
$G + AD= $G) + AWE) HBO ul) 
+GDSDR DU) — HG)EC)]} At 
+KG-+ AD) (zG + At) — HG + ADEC) 
HAWE) + Bu + GSDR 0) 
X (z(t) — H) $(0))JA:J) 
将 上 式 两 端 同 减 8(z) ,并 除 以 At, 然后 求 Az— 0 时 的 极限 ,考虑 到 式 (8. 3. 9) 关 系 时 
a= lim $G i A) — 20) 
=] At 


= A(DE(D HBU) HK, Dlt) — HAU] (8. 3. 10) 
式 中 
K= KO +G(OS(OR- GD 
= [PWH 0) EOSO] (CD (8. 3. 11) 
式 (8. 3. 10) 就 是 所 求 的 最 优 滤波 方程 , 式 (8. 3. 11) 就 是 滤波 增益 矩阵 方程 。 
下 面 推导 滤波 方差 矩阵 黎 卡 提 微 分 方程 。 
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将 式 (8. 3. 6) 及 式 (8. 3. 8(c)) 代 人 式 (8. 3. 8(e)) ,得 
POH At, t) = PG,t) +[AG)PG, t) + PG, ATC) 
—G(OSG)DR 1GDOH0GDP(z,r) 
— PO, DH OAR ASHO A) HGO a) 


一 G(DSCDR- SGT JA (8. 3. 12) 
求 式 (8. 3.12) 4 Az — 0 时 的 极限 ,得 
JimPG 十 At 有 一 PCD = PO) (8.3.13) 


将 式 (8. 3. 12) 代 入 式 (8. 3. 8(f)), 在 等 式 两 端 减 去 PO), 并 除 以 At, R4 Az — 0 
时 的 极限 ,得 

lim PC 士 AD) 一 PCD) _ a) 

1 At 


SAWP) POATE) —GOSHOR? HOPE) 

—P(OH OR OSAGT) 

一 G(D)S(CDOR OSAGT U) + GQ GT —KOHUPE) (8.3.14) 
考虑 到 式 (8, 3. 9) 及 式 (8. 3. 11) , 则 式 (8. 3. 14) 变 为 
BO = AWP) + PAT +G()Q)GT O) 
—K,(DR KT) (8. 3. 15) 
综 上 所 述 ,线性 连续 系统 卡尔 曼 滤波 的 一 般 形 式 为 

$O SAWU) +BOu) HK, ACz) — HORCG)] (8.3.16(a)) 


K,(t) = [POHE (2)G(2)SC0) JR a) (8. 3. 16(b)) 
P(t)= AOPA) + P(DAT(0 十 GGDQCGDOGTCD) 
=K, R KT) (8. 3. 16(c)) 


8.4 滤波 的 稳定 性 及 误差 分 析 


第 6 章 讨 论 了 离散 系统 卡尔 曼 滤波 器 的 稳定 性 问题 。 与 离散 系统 类 似 的 是 ,如 果 
线性 连续 系统 的 卡尔 曼 滤波 器 是 稳定 的 , 则 对 于 任何 不 确切 初始 条 件 ,或 者 有 偏差 ,都 
不 会 影响 滤波 器 的 正常 工作 。 当 时 间 充分 长 以 后 ,状态 估计 值 最 终 将 趋 近 于 最 优 ,而 与 
初始 值 的 选取 无 关 。 当 然 ,滤波 器 的 稳定 性 取决 于 它 的 结构 和 参数 。 


8.4.1 滤波 器 的 稳定 性 


考查 由 式 (8. 1. 8) 描 述 的 线性 连续 系统 的 最 优 滤波 方程 ,可 将 其 改写 为 
tO = [AGO — KO HOG) JR) HKO) (8. 4.1) 
AC. 4. 1) 描 述 的 卡尔 曼 滤波 器 的 状态 方程 实际 上 是 一 个 线性 系统 。 其 中 , z(z) 是 
系统 的 输入 项 。 若 将 式 (8. 4. 1) 写 为 





* 216 。 最 优 估计 理论 





$G) = ÂO HKO) (8.4.2) 
则 


ÂG) = AG) —K( HG) (8.4.3) 
是 滤波 器 的 系统 矩阵 。 
所 谓 滤波 的 稳定 性 ,实际 上 是 指 方程 式 (8. 4. 2) 解 的 稳定 性 。 下 面 采用 李 亚 普 
诺 夫 稳定 性 理论 研究 滤波 的 稳定 性 。 
如 果 由 滤波 方程 式 的 齐 次 方程 
(1) = ÂA) (8.4.4) 


描述 的 自由 系统 是 稳定 ,渐进 稳定 或 一 致 渐进 稳定 的 , 则 称 方程 式 (8. 4. 2) 所 描述 的 
滤波 器 系统 是 稳定 ,渐进 稳定 或 一 致 渐进 稳定 的 。 考 虑 到 滤波 器 系统 是 稳定 的 , 则 
其 稳定 性 还 是 大 范围 的 。 若 线性 滤波 系统 是 一 致 渐进 稳定 的 , 则 意味 着 系统 也 具有 
有 界 的 测量 输入 O 导致 有 界 的 状态 估计 输出 稳定 性 。 


对 于 随机 线性 连续 系统 
Alt) = AG)x(2) + G(t)w(t) (8. 4..5(a)) 
20) = H(Dx(D +o (D) (8.4.5Cb)) 
如 果 对 于 任何 初始 时 刻 0 , 有 能 控 矩 阵 
Welto»t) = [ ee,oceoococteoera,oar > 0 (8.4.6) 
则 系统 状态 是 完全 能 控制 的 。 
如 果 存 在 a > 0,B > 0,4o HERNA. HF t> t, 有 


a I< Wecltost) SAI (8.4. 7) 
则 系统 是 一 致 完全 能 控 的 。 
如 果 对 于 任意 初始 时 刻 z , 有 能 观测 性 矩阵 


Wold = | BT DH OR OHOO (8.4.8) 


° 
则 系统 状态 是 完全 能 观测 的 。 
如 果 存在 wm>>0, 忆 >>0, 思 为 任意 时 刻 。 对 于 上 > o, 有 
ml <Wolto,t) < RI (8. 4.9) 
则 系统 是 一 致 完 全 能 控 的 。 
应 该 指出 ,上 述 随机 线性 连续 系统 的 能 控 性 是 对 系统 随机 干扰 w(z) 而 定义 的 ， 
它 反映 了 系统 干扰 WO 对 系统 状态 的 影响 能 力 。 当 系统 存在 确定 的 输入 项 uC) 
Bf, 对 于 w(z) 而 言 的 能 控 性 与 确定 系统 的 情况 完全 相同 。 
有 时 不 需求 解 滤 波 误差 方差 方程 ,而 只 需 估计 误差 方差 的 范围 ,这 时 需要 考虑 
滤波 误差 方差 的 上 下 界 问 题 。 
如 果 式 (8. 4. 5) 所 描述 的 随机 线性 连续 系统 为 一 致 完全 能 控 和 一 致 完 全 能 观 
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的 , 则 当 上 之 如 十 人 时 ,滤波 误差 方差 满足 下 列 不 等 式 
I< po < Lt GD, (8.4.10) 





1+ Gg 
式 中 ,n 为 系统 状态 变量 的 维 数 。 
定理 8. 1( 滤 波 稳定 性 定理 ) 如 果 式 (8. 4. 5) 所 描述 的 随机 线性 连续 系统 为 一 
致 完全 能 控 和 一 致 完 全 能 观 的 , 则 其 最 优 滤波 是 一 致 渐进 稳定 的 ,而 且 是 大 范围 一 
致 渐进 稳定 的 , 即 存在 常数 ct > 0,cs >> 0, 使 得 对 所 有 的 z 达 为 三 0, 有 
lD, to) || < ¿entes (8.4.11) 
且 当 :一 co 时 ，|| De) | 一 0。 式 (8.4. 1D, OG) 为 滤波 器 的 状态 转移 矩阵 。 
证 设 系统 式 (8. 4. 5) 为 一 致 完全 能 控 和 一 致 完全 能 观 的 , 则 滤波 估计 误差 的 
方差 阵 PCz) 必 为 正定 的 , 且 有 一 致 的 上 界 和 下 界 , 即 PO) 存在 。 选 取 李 亚 普 诺 夫 
函数 为 如 下 二 次 型 


VERG), t] = TOPOR) (8. 4. 12) 
则 VERG) ,t= FOP OAO HTP OA) 
+#TG)P C) $G) (8.4.13) 


将 式 (8. 4.4) 代 和 人 式 (8.4. 13) ,得 
VEEG) t] SE (AT (PDR) + RT DP DL) 


+ET(DP (ACE) (8.4.14) 
或 VEEG), t] =— T OAO) (8. 4. 15) 
式 中 =Â) = AT(P +P OAG) +P C0) (8.4. 16) 


因为 . 
P(t) =—P'G)P(OP a) 
将 式 (8. 2. 8) 代 入 式 (8.4. 16) ,得 
B= P WOAH ATP C) 
一 PCD)GCGD)QCGDIGTCDPIGD) + H'G(OR (OHG) (8.4.17) 
将 式 (8.4.17) 代 入 式 (8. 4. 16) ,得 
QG) = PWGHQODG HP G) FHIORIDHG) (8.4.18) 
BFPO 是 正定 的 , 且 有 一 致 的 上 界 和 下 界 ,因此 有 . 
V[$€O,:]2>20, VERGE), <o 
因此 ,滤波 系统 是 大 范围 一 致 渐进 稳定 的 。 需 要 说 明 的 是 ,由 于 李 亚 普 诺 夫 稳定 性 
定理 给 出 的 是 系统 稳定 的 充分 条 件 , 所 以 条 件 式 (8. 4. 10) 也 只 是 充分 条 件 。 
滤波 稳定 性 定理 说 明 , 当 测量 时 间 足 够 长 时 ,对 于 由 式 (8. 4. 4) 描 述 的 自由 系统 
状态 ,有 





lim|| z% || =0 


这 说 明 滤波 系统 的 最 优 滤波 值 最 终 与 初始 状态 如 何 选取 无 关 。 
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需要 说 明 的 是 ,滤波 的 稳定 性 并 不 等 价 于 控制 系统 本 身 的 稳定 性 。 滤 波 方程 稳 
定时 ,其 相应 的 滤波 系统 可 以 是 不 稳定 的 。 在 系统 失去 控制 而 使 状态 不 断 增长 时 ， 
若 滤波 器 仍 能 不 断 估 计 出 系统 的 状态 ,并 保持 估计 误差 有 界 , 则 滤波 器 是 稳定 的 ,这 
也 是 滤波 器 应 该 具有 的 性 能 。 

如 果 系 统 式 (8. 4. 5) 为 一 臻 完全 能 控 和 一 致 完全 能 观 的 , PP 和 PË” 是 两 个 不 同 
的 初始 估计 误差 方差 , 按 它 们 求 得 上 时刻 的 估计 误差 方差 分 别 为 PCD 和 P? G) , 
则 存在 常数 c, > 0, , > 0, 使 得 对 所 有 的 上 之 如 , 有 š 

WPP a) — PP) || < ce %%-* || Pp — P$ || (8.4.19) 
34 £ — co PF, lim || P? (O) =P” W || = 0 (8.4. 20) 
这 说 明 , 当 测量 时 间 充 分 长 后 , 滤波 估计 误差 的 方差 也 将 最 终 与 初始 误差 方差 阵 的 
选取 无 关 , 而 趋 于 稳 态 值 。 可 以 证 明 , 滤 波 增益 矩阵 也 具有 这 种 渐进 特性 。 

例 8.3 系统 的 状态 方程 和 观测 方程 分 别 为 


Borb deori 
Kolki skeho 
设 wa) A o (0) 都 是 均值 为 零 的 白 噪声 , 互 不 相关 , 且 有 


E[w(z) J = E[u] = 0 
EWW (7)] = @G —> = gq6(t—7) 


í 0 
; kap 


E[u G vi (e) ] = R8G — r) = É 六 


试 判定 卡尔 曼 滤波 系统 的 稳定 性 。 
解 由 系统 方程 和 观测 方程 可 知 


Ü J e=] =Ë 2) 


可 求 得 系统 的 转移 矩阵 为 
oa) = È a] 


0 1 
首先 求 可 控 性 矩阵 Welt ,2) o 
DEDET Fi jeaol， 1 °] 
mF 


set Fil ; 


t—r 1 


Welo ,t)= Í, DU DGDGT DBT ,Ddr 
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y PE T ` Szs2 
=ef [E2 Ji e> 
k] 


t—r 1 
G=? Uur 
3 2 
一 于 >0 
(t— t)? 
~ tb 


因此 系统 一 致 完全 能 控 。 
下 面 求 可 观 性 矩阵 Wo Co +t) 。 
OC DH ER HO DE,) 


n rs, 


0 


hi hi(r—t) 
二 | “好 rt 
u M: 
2 


Mr—t) M GD: 
4 tA 








hi hao 
u rt r 
Wea,p= fi P w En G> 1) 

ri r r 

hi lt— to) hi (一 名) 
r 2r 

ar >0 
hi G—t)2 hLG— t) hlt- t) 
3 + 





2ri ri r: 
因此 系统 一 致 完全 能 观测 。 
由 稳定 性 定理 可 知 ,滤波 系统 稳定 。 


8. 4.2 滤波 器 估计 误差 分 析 


当 数 学 模型 不 准确 ,噪声 统计 特性 不 准确 ,初始 状态 估计 有 差异 ,或 者 只 有 其 中 
一 种 因素 存在 时 ,卡尔 曼 滤波 器 不 再 是 最 优 的 ,而 是 次 优 的 。 下 面 分 析 上 述 因素 存 


在 时 滤波 器 的 误差 。 
设 真实 的 线性 连续 系统 为 
tC) = Axl) HGW) (8. 4. 21(a)) 
z(t) = HG)xG) +o (t) (8. 4. 21(b)) 


式 中 ， 
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Elwa] = Elo G)] = 0 

CovLw(t) ,w(z)] = QO — r) 
Cov[v (z) ,c G) ] = ROSG — r) 
E[x(z) ] = uz Go), Var[x(to)] = P, 


在 设计 和 使 用 卡尔 曼 滤 波 器 时 ,应 用 了 如 下 不 准确 的 系统 模型 噪声 统计 特性 和 


初始 状态 (wo), 即 Š 
E(t) = AOR) + GG) WE) 


alt) = AWE) +o GO 


RP DO] = E[%()] = 0 

Cov[#(z2) ,wr)] = OO — r) 

Cov[% (z) ,6 (z) J = ROX — r) 

E[x(&)] = ñ: Cto), Var[x(t)] = P, 
H) 与 W(t) #ll 6 (0 不 相关 。 

系统 的 滤波 方程 为 

XG) 一 AWO) HRO — Aaa) 
RKO) = POR OR a) 
PO = AWP +POA A) 
-POF (OR OAH PCO) +G(0QG)GTGD) 


初始 条 件 为 = 
Cto) = f: (to) PCto) = P, = Var[x(z)J 
实际 估计 误差 及 其 均 方 误差 为 
Talt) = x(t) —x(z) 
P.G) = E[x, GO) x (2) J 
若 令 s 
AG) = AC) — AAC) 
Ga) = GC) — AGC) 
Ac) = H) — AHC) 
则 有 


(1t)= [AG ROAA] A) 


(8.4.22(a)) 
(8. 4. 22(b)) 


(8.4. 23) 
(8.4. 24) 


(8.4. 25) 


+[AAG) — KGO AH(0 Jx) HGW) — KCE) v (2) (8. 4. 26) 


P.G)= [AGO 一 六 (2) 百 (CD]P.(z) +P, OAO -ROANT 


十 [LA4(b KOAH Par, (2) + P, OLAH ROAT 


HEWWE GO + KG)R(OKTG) 
式 中 , Pa, O = E[x(z)x.(z)], 它 满足 方程 


(8. 4. 27) 
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Ba, = AHP, O) + P,,, OAO RORO] 


+P.(O[AAG) — KOAH] HGOQAG E) (8.4. 28) 
式 中 , P.G) = E[x(Ox!(0], 满足 方程 
P.G) = AWP: Ct) + POATA + GQ GT E) (8. 4. 29) 
式 (8.4. 27)— (8. 4. 29) 的 初始 条 件 为 
P, (to) = EL 3a (to) X3 Go)J = Var[x(t)]+ Ap Cto) AHT Cto) 
了 Ps (to) = ELx(to) XI Cto) ] = Var[x(t,)] + pz (to) AHT Cto) 
P; Cto) = E[x, (te)xI Cto) ] = Var[x(t)] + pr Cto) HE Cto) 
式 中 , p(to) = ECx Cto) ] 
Ap. (to) = ELx(to) —x(t)J = E[x,(0) J = p Cto) — Fz (to) 
求 得 上 述 方程 后 ,就 可 以 对 滤波 器 进行 灵敏 度 分 析 , 从 而 可 知 系统 参数 变化 (不 准 
确 ) 时 , Pa C) 偏离 最 优 值 的 情况 。 
假定 系统 式 为 式 (8. 4. 21) ,而 初始 值 为 *(0), 初始 误差 方差 阵 BC0) .QC0) 及 
RO) 与 真实 值 表 误差。 因此 ,对 应 的 有 K(z) 不 再 是 最 优 增益 ,而 相应 的 滤波 值 xC) 
不 是 真实 的 最 优 滤波 x(z) PO 也 不 再 是 真实 的 滤波 误差 方差 阵 PU). 
令 














a(t) = x(t) —x(t) 


则 真实 的 滤波 误差 方差 阵 为 
P, (t) = E[r OTa] (8. 4. 30) 
它 应 该 满足 关系 
P.G) = [AGO -KOHO IP, DIAG) -ROAT 
+R(RCG)RT) + GQ)GT) (8. 4. 31) 
式 中 
Ka) = POE WR (O (8. 4. 32) 
而 由 滤波 器 算出 的 滤波 误差 方差 阵 为 
Pa = [AG) — KC() HG) P(O HPOO — ROH) 
HEOROR A) 十 GGDGCDGT O) (8. 4. 33) 
令 


APC) = P(O) — P, (t) 
ARG) = RG) — RC) 
AQ) = 00) — Qa) 
则 用 式 (8. 4. 33) 减 去 式 (8. 4. 31) ,得 
AÈ = [AGO -KOHO JAPA) + AP(D[AGD — RO HOG] 
+K) ARCG)KTG) + GG) AQGDGTGOD (8.4.34) 
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RCE. 4. 34) 是 APO) 的 线性 微分 方程 ,可 以 求 得 其 显 式 解 为 
AP(t)= V.G,0)AP(0)V2 (2,0) 


十 | Ve DROGOK VE,s)ds 


+ [v.66 a0 GT OVE Ce, s)ds C8. 4. 35) 
RP, V.(t,s) 由 下 式 确 定 
st =T[AG) -KOUYON G, s) (8. 4.36) 


其 中 , r2 s2>0, BVs) = L, 
由 式 (8. 4. 35) 可 知 , AP(z) 是 实 对 称 和 矩阵 之 和 。 因 此 ,只 要 式 (8. 4. 35) 中 右 侧 
的 每 一 项 都 是 非 负 定 的 , AP(z) 就 是 非 负 定 的 。 据 此 ,可 得 两 个 结论 : 
结论 1 若 系 统 的 A(z)、GL) 和 H(t) 都 是 精确 的 , 当 满足 条 件 
DS, RG) ZR, t>r>0 
并 且 五 0) > P. (0), 则 当 : 宇 0 时 ,有 
P) > P. (t) 
根据 上 述 讨论 可 直接 推 得 这 个 结论 。 其 作用 是 ,尽管 设计 者 不 能 精确 已 知 噪声 及 初 
始 方差 的 先 验 知识 ,但 是 只 要 上 述 条 件 满足 , 则 仍然 能 够 使 所 设计 的 滤波 器 在 规定 
的 范围 内 良好 地 工作 。 
结论 2 ERER AG GO) 和 H(z) 都 是 精确 的 ,而 当 满足 条 件 
DDK), ROKR), t>r>0 
3Ë B. PCO) < P, (0), W4 t>o A 
Pa) < P.G) 
还 可 进一步 推出 ,在 结论 1 的 情形 下 , 若 系统 一 致 完全 能 控制 和 一 致 完全 能 观测 , 则 
PG) 有 一 致 的 上 界 。 


思 考 题 


8-1 已 知 一 阶 系统 模型 如 下 
(党 =— x(t) +w.) 
z) = x(0) +o (2) 
RP, WO M oW 为 零 均值 不 相关 白 噪 声 过 程 , 且 有 
E[w(z)w(z)]J = 2a5(t— r) 
E[o(O o CG)] = @t— r) 
求 平稳 卡尔 曼 滤波 器 。 
8-2 设 一 维 连续 系统 的 状态 方程 和 观测 方程 为 


第 8 章 线性 连续 系统 卡尔 曼 滤波 "223 + 





+G) =— 2. 5x(t) +w(t) 
z(t) = 3x(t) + o (t) 
式 中 , w(t) 和 (0) 为 零 均值 的 白 噪声 ,统计 特性 为 
ECwa)]= E[o (0 j= 0,E[w(Ow! (r) J= tr) 
ELv(t) o! er) J= 2080€Gz— r) ,ECw(t) vi <r)]J= 6(t—r) 
设 E[x(0)J = 1, P(0) = 1。 设 观测 时 间 间 隔 为 0. 1*, 相 应 的 观测 值 为 
z(0) = 1,z(0.1) = 0.9,z(0.2) 一 0.8 
z(0. 3) = 0.7,z(0.4) = 0. 6,z(0. 5) = 0.5 
求 估 值 $G + l| 有 )。 
8-3 某 一 阶 系统 的 状态 方程 和 测量 方程 为 
tlt) = Ax (t) + Fw(z) =— x3(z) + w(t) 
z(t) = x(t) +o (t) 
WA) fl o (2) 的 统计 特性 为 
E[w(#)] = 0,E[w(t)w! (z)] = 28(—7) 
E[o (t) J = 0,E[o () oT()] = 18t — r) 
初始 状态 为 
x(0) = x, = 1, Var[x(0)] = P, = 0 
且 x(0) .wb 和 w(t) 互 不 相关 。 求 卡尔 曼 滤波 方程 滤波 增益 和 方差 。 
8-4 设 有 连续 时 间 模型 为 


CD) = Ë Fo +[ e 


zt) = [1 0]xG@) +o (O) 
式 中 ,系统 干扰 和 测量 噪声 的 能 量 密度 矩阵 为 
QW) = ÈRO = 
求 该 系统 的 状态 估计 $€) 。 
8-5 设 发 送信 号 是 由 一 阶 微分 方程 
Ale) = ax(t) + wit), t> 0 
描述 的 随机 过 程 样本 函数 ,已 知 ac 之 0,E[x(0)] 一 0,EL (0)]= al v (r) 是 零 均值 白 噪声 ,方差 为 
E[o (Q) v ()] = 玫 ( 人 一品。 构造 卡尔 曼 滤波 器 估计 最 佳 输出 (2) 。 
8-6 假设 信号 和 观测 模型 为 
tC) =— x(t) +/2w(D) 
z(t) = xG) +o (t) 
式 中 , w(t) 和 wb) 都 是 零 均值 单位 方差 的 白 噪声 。 试 求 最 优 卡尔 曼 滤 波 器 。 
8-7 连续 观测 方程 z(t) 为 
alt) = at +n(t) 
其 中 , a 为 高 斯 随机 变量 , a~ N(0,1),n() 为 高 斯 白 噪 声 ,， E n() ] = 0,E[n()n(2)] = 28( 一 口 。 
试 构造 估计 a 的 最 优 滤波 器 ,并 证 明 其 稳定 性 。 
8-8 已 知 飞机 自动 驾驶 仪 高 度 保持 状态 的 微分 方程 为 
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KCE) +0. 006ÁCE) 十 0. 003kCD = 0. 3Cha Ce) +0. Olho t) 1 
式 中 ,六 代表 高 度 , ho 表示 指令 高 度 。 指 令 高 度 可 以 模拟 为 一 个 恒定 高 度 ke 加 上 指令 通道 的 高 斯 
白 噪声 Sho (2) : ho Ga) = ho 十 6ho Ct), HERE ho 是 一 个 正 态 随机 变量 ,统计 特性 为 
Echo) = 3000m,oz Cho ) = 75000m° 
指令 通道 的 噪声 具有 以 下 统计 特性 : ho ~ NC0,120m? ) , H She 与 所 有 的 其 他 变量 无 关 。 每 隔 
10s 可 以 得 到 高 度 的 一 个 离散 测量 值 ,包含 随机 误差 
z(&) = hlt) + w(&) 
式 中 , z(a) 是 测量 高 度 ,而 a (a) 是 测量 误差 的 白 噪声 序列 : w ~ N(0,30m?)。 试 确定 表示 h(z) 
最 小 方差 估计 器 的 差分 方程 ,并 用 标量 形式 写 出 这 些 方程 。 
8-9 考虑 线性 系统 
+£ = x (0) 
£ =— mam (t) — az xe (t) + w(t) 
观测 变量 为 
Llu) = m CHo Ct) 
RP, a 和 gs 为 未 知 常数 , w(t) A o (#) HERRENA, RH ARM a, 
和 a 的 卡尔 曙 滤 波 器 算法 。 
8-10 试用 新 息 推导 法 推导 误差 方差 阵 的 黎 卡 提 微 分 方程 
PGD = AWPU) + P(DAT (O — POH OR? (OHOP) 
+G(OQCDG' (O 


第 9 章 ， 非 线性 系统 滤波 


内 容 提要 ”介绍 若干 非 线性 系统 的 滤波 方法 ,主要 包括 基于 条 件 概率 密度 估计 
的 贝 叶 斯 滤波 ,基于 泰勒 级 数 展开 的 扩展 卡尔 要 滤波 ,基于 统计 线性 回归 的 
Unscented 卡尔 受 滤 波 法 和 中 心 差分 卡尔 曼 滤 波 法 ,基于 蒙特 卡 罗 模 拟 的 粒子 滤波 
法 ,以 及 统计 线性 化 滤波 和 非 线性 预测 滤波 等 。 
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前 面 章节 研究 的 卡尔 曼 滤波 要 求 系统 是 线性 的 ,但 实际 的 系统 模型 都 存在 一 定 
的 非 线性 ,而 且 往往 是 不 能 忽略 的 ,如 卫星 的 导航 系统 .导弹 的 控制 系统 .飞机 的 飞 
行 控制 系统 以 及 许多 工业 控制 系统 等 。 在 这 些 情况 下 ,为 了 更 加 精确 地 得 到 估计 结 
果 , 系 统 必须 如 实 反映 非 线性 特性 ,因此 必须 考虑 非 线性 系统 的 状态 估计 ,或 者 说 非 
线性 滤波 问题 。 

对 于 线性 高 斯 系统 ,卡尔 曼 滤波 是 方差 最 小 意义 下 的 最 优 解 。 然 而 对 于 非 线性 
系统 ,其 最 优 解 一 般 不 能 用 闭合 形式 表示 , 主要 影响 因素 如 下 ， 

(1) 尽管 系统 初始 状态 和 噪声 是 服从 于 均值 为 0 的 高 斯 分 布 ,但 是 非 线性 变换 
会 使 分 布 函 数 变 得 十 分 复杂 , 系统 状态 和 输出 不 再 服从 于 高 斯 分 布 ,因此 建立 在 高 
斯 分 布 基础 上 的 估计 理论 就 不 再 适用 。 

(2) 由 于 非 线性 的 存在 ,系统 状态 关于 新 信息 的 条 件 均值 和 条 件 协 方差 矩阵 可 
能 依赖 新 信息 的 高 阶 矩 ,因此 不 能 建立 简单 的 递 推 关系 或 用 简单 的 微分 方程 表示 。 

(3) 鸽 加 原理 不 再 成 立 。 在 非 线性 系统 中 ,控制 输入 混 人 新 信息 中 ,对 于 输出 状 
态 的 估计 将 产生 很 大 的 影响 。 因 此 ,在 非 线性 的 情况 下 ,实时 信息 将 包括 输入 和 输 
出 数据 ,因此 信号 处 理 的 难度 较 大 。 

通常 用 于 非 线性 系统 估计 的 研究 方法 主要 有 概率 法 、 新 息 法 和 统计 法 。 这 些 方 
法 给 出 了 计算 公式 , 且 从 理论 分 析 上 是 严谨 的 ,但 离 实际 应 用 还 有 一 段 距离 。20 世 
纪 70 年 代 以 后 ,人 们 一 直 按 以 下 两 个 方向 寻求 工程 上 实用 的 非 线性 滤波 近似 算法 : 
一 是 条 件 概 率 密度 的 近似 ,如 高 斯 和 法 及 正 交 级 数 展开 法 等 ; 另 一 个 途径 是 动态 方 
程 和 测量 方程 的 近似 ,如 描述 函数 法 和 泰勒 级 数 展开 法 等 ,获得 非 线 性 系统 的 近似 ， 
然后 利用 线性 系统 的 滤波 结果 建立 非 线性 系统 的 滤波 方程 。 这 种 方法 虽然 含 去 了 
某 些 高 阶 项 ,但 却 可 以 获得 一 套 相对 简单 的 计算 公式 ,对 于 某 些 问题 可 以 得 到 足够 
精确 的 计算 结果 ,因此 具有 重要 的 应 用 价值 。 非 线性 系统 近似 的 方法 有 很 多 ,这 也 
使 得 非 线性 滤波 没有 固定 的 方法 和 形式 ,而 是 拥有 更 多 的 解决 方法 和 实现 途径 。 
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9.2 贝 叶 斯 滤波 器 


9.2.1 离散 非 线性 系统 的 贝 叶 斯 滤波 器 


假设 离散 非 线 性 系统 的 状态 方程 和 观测 方程 
Xin = f(x u, k) 十 wen (9.2.1(a)) 
z, = h(x sk) +w (9. 2. 1(b)) 
式 中 , x 为 n 维 状态 向 量 , u, 为 > 维系 统 确定 性 控制 输入 向 量 , xx 为 m 维 观测 向 量 ， 
FORRO) 分 别 为 n 维和 m 维 函数 向 量 。w 和 vw 分 别 为 n 维和 m 维 的 高 斯 白 噪 
声 过 程 ,其 概率 密度 分 别 为 Pa CW) A PCO), 初始 状态 x, 具有 已 知 的 概率 密度 函 
数 已 (zo), H wo 和 xo 三 者 是 彼此 不 相关 的 。 
假定 在 时 刻 已 经 获得 实时 信息 
Z* (k) = {Z$ Ut} (9. 2. 2) 
RIP, Z) = (zz sz) UPA = (torth ytsta) n 
贝 叶 斯 滤波 估计 问题 ,就 是 在 给 定时 刻 实时 信息 Z"(&) 的 情况 下 求 状态 x, 的 
条 件 概 率 密度 


px | Z° (h)) (9. 2. 3) 
求 得 了 条 件 概率 密度 , 则 x, 的 最 小 方差 估计 就 是 x, 的 条 件 期 望 , 即 
$a = E[x, | 2° (1] = Í” xp, | Z° dw (9.2.4) 


而 估计 误差 x, = x, 一 $, 的 条 件 协 方差 阵 为 
P, = Cov[ x, , x, | Z° k)] 


= C. — s) Ga — tu) pO | Z° QD)dx, (9.2. 5) 


可 见 , 贝 叶 斯 滤波 问题 归结 为 如 何 递 推 求 得 条 件 概率 密度 p(x | Z° (k) 的 问 
题 。 在 给 定 xia 和 wr 的 条 件 下 , x 只 依赖 we Cw) j xa Xa t" X 相互 独 
立 ) ,这 样 ,状态 序列 就 构成 了 马尔 可 夫 序列 。 于 是 有 
Dx | x) = Pk +H 1 xinsk, x | ux) (9.2. 6) 
根据 贝 叶 斯 规则 , 式 (8. 2. 6) 又 可 以 表示 为 


De | xes) = Ë ooa We | X, Ua) dw 


= pm | wos pO | mm) dw (9.2.7) 
再 根据 win 的 独立 性 及 式 (9. 2. 1) ,得 


Pin | mw) 一 | aa — S rta rt) ps M dwn 
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一 加 (Xe — f (k, Xr i)) (9.2.8) 


式 中 , 86(，) 为 狄 拉克 8 函数 。 

上 式 表明 ,条 件 概率 密度 是 以 『(k,xi ,ui) 为 均值 ,形状 与 w+ 相同 的 一 个 概率 
密度 函数 。 进 一 步 ,利用 切 普 曼 - 柯 尔 莫 哥 洛 夫 (Chapman-Kolmogorov) 方 程 得 zh 
一 步 提前 预报 的 条 件 概率 密度 函数 为 


Pam | z" Q),u)= | nr | xu pls | z" dx 


= |? pein — frst ) px | z" da (9.2.9) 
类 似 地 ,根据 式 (9. 2. 1) 的 特点 及 ve 的 独立 性 ,得 
plzar | aa 一 | plam roe | xi) doen 


= [Pa | Xiti 5081) Po CVn) dok) 


= 办 (zt — h(k + 1,x+a)) (9. 2. 10) 
式 (9. 2. 10) 表 明 , 给 定 xan 时 ,zi 的 条 件 概率 密度 以 hCk 十 1,xxr1) 为 均值 ,形状 与 
ven 的 概率 密度 相同 。 
据 此 ,得 zi 的 一 步 提前 预报 条 件 概率 密度 为 


Pan | 2° Qu) = plasm sain | z Ouden 
= |” pena | ua) pG 1z Q) a) dava 


= |? p. ARH le) Pa | 2" Q) deen 


(9. 2. 11) 
在 & 十 1 时 刻 ,如 果 测 量 zr 已 经 获得 , 则 可 利用 贝 叶 斯 公式 求 得 后 验 概率 密度 
的 更 新 公式 为 
轧 (xt | Zen) = Plam | z" (R), ze th) 
四 (XehH yz z" (Ë), 
M GO 8.2.12 
RO. 2. 12) 分 子 可 表示 为 
力 (XeH Zea | z" (R) ua) = pxin | zi) px | z* Ck) sui) 
S Palzem Shk + ls xn)) pr | z" (k) su) 
(9. 2. 13) 
于 是 ,有 
bn | z" +1) z Pollen — hlk + lx) px | z" Ck) su) 


Prim Shk H 1,xe)) pO | z" Ck) su) dx 
(9. 2. 14) 
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RO. 2. 14) 就 是 贝 叶 斯 滤波 公式 。 式 (9. 2.14) 中 , Pen | z` (k) ,wu) HRO. 2. 9) 
确定 , z" RHD = {2° (k) ,mm za) 均 为 给 定 值 。 

如 果 非 线性 系统 的 噪声 不 是 加 性 的 ,将 得 不 到 式 (9. 2. 8) 和 式 (9. 2. 10) 的 简单 
形式 。 即 使 在 上 述 假设 条 件 下 , 贝 叶 斯 滤波 在 每 一 步 的 积分 运算 都 是 非常 困难 的 ， 
甚至 可 能 得 不 到 解析 表达 式 , 因而 没有 重要 的 应 用 价值 。 但 是 , 贝 叶 斯 估计 毕竟 给 
出 一 种 直观 的 精确 表达 式 , 具 有 一 定 的 理论 分 析 价值 。 


9.2.2 连续 非 线性 系统 的 贝 叶 斯 滤波 器 


考虑 连续 非 线 性 系统 
Ct) = f(xGt) yt + g(x(t),t)w(t) (9. 2. 15) 
z(t) = h(xG ,t) +o (t) (9.2.16) 
式 中 , w(z) 和 vw(z) 是 零 均 值 高 斯 白 噪 声 , 且 与 初始 状态 xC) 互 不 相关 , 即 
E[wa)] = E[o ()J = 0 
Cov[w(¿) ,w(z)] = QAE — r) 
Cov[v (t) v (z)] = RO — r) 
Cov[w(2) ,o (z) J = Cov[w(2) ,x(z.)] = Cov[o (t) xlro)] = 0 
将 式 (9. 2. 15) 改 写 为 随机 微分 方程 形式 , 则 有 


dx(D = f(x(t) ,)dr + g), DANG) (9.2.17) 
RP, NO 为 维 纳 过 程 ,满足 

E[dN(1)] =0, Var[dN(CD] = Q(t)dt 
定义 新 的 测量 量 yC, 它 满足 

dy(t) = z(t)dt 
其 中 . dy( = y(t+ d) 一 了 CD) 
于 是 ,测量 方程 可 以 写成 
dy( = h(x(2) ,0) d+ dM) (9. 2. 18) 


AH, MO) EERIE 5 NG) 独立 , 且 有 
E[dMGO]= 0, Var[dM(z)] = RG)d: 
这 样 ,就 可 将 非 线性 系统 用 随机 微分 方程 式 (9. 2. 17) 和 (9. 2. 18) 描 述 。 
获得 新 的 测量 数据 Z" (z) EÑ Y" GO 后 ,可 导出 修正 的 福 克 尔 - 普 朗 克 (Fokker- 
Planck) 方 程 , 即 
D), t+ dt | Y* G+d)) — pelt), | Y" G) 
(OO IÉ 2 Da 








+ (sa [ (ss) ODOT Ce Dp st IY* o) ]|a: 
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HA) t | Y" MEy) — hlt) ,dTTR Lh) ,4) — Á xlt) ,2)] 
(9.2. 19) 
或 
dpt), | Y° (0) 
at 


Ə(f(x(D t) px), t | Y* (22) 
e( xU) ) 





telalla) {g(x(D ,DQ aT EO DPED Y 0) ]) 


+ p(x(t),t | Y" E) — halt) t) TTR Ohal) t) —ÁCxG),t)] 
(9. 2. 20) 
RP, ÂA), t) = E[h(xGD ,2) | Z° (0)] = Elhe) t) | Y* (OJ 
Z° (0) = (z(z),ts StSt} 
Y* C) = {yD ,tb < r < t) 
显然 有 
PCxG2) t | Y° () = p(x(0) t | Z° (2) 
这 是 因为 Z* G) 所 含有 的 关于 xG) 的 信息 和 Y* (z) 所 含有 的 信息 同样 多 。 
由 估计 理论 可 知 ,最 小 方差 估计 就 是 条 件 均值 。 对 于 非 线性 系统 式 (9. 2. 17) 和 
式 (9. 2. 18) ,在 获得 测量 数据 Z° G) RY GO) 后 ,状态 x(7) 的 最 小 方差 估计 &(t) 是 
x(2) KFZ G) 的 条 件 均值 , 即 
L= ELC) | Z° G] 
= [T OED, | Z° Odro (9. 2.21) 


估计 误差 方差 为 
了 (iD 一 Var([Lx(b) —£(2)] | Z° (0) 


一 [reo —£G)][xG) — $G)JT'p(x(OD t | Z* dælt) (9. 2. 22) 


如 果 能 用 修正 的 福 克 尔 - 普 朗 克 方程 求 得 条 件 概率 密度 p(xCz),t | Z° (2)), 则 非 线 
性 状态 估计 问题 可 以 解决 。 在 式 (9. 2. 19) 两 侧 同时 乘 以 x(z), 然后 对 x(z) 从 一 co 


至 十 ce 积分 ,经 过 推导 ,可 得 条 件 均值 为 
dE) = f(x(2) ,0 d+ E([xGO — EJAT), t) | Y* (O) 
XR? C) {dy — Â Cx) ,t)dt} (9. 2. 23) 
式 中 


f) t) = ELF) t) | Z* G)] = E[f(xGO,0) | Y* (2)] (9.2. 24) 
应 的 估计 误差 方差 阵 为 
APCE) HAROT = EL fE) ,DLx() — T" | Y° GD) dz 
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+E([xG) EJAT) ,0) | Y" G) )dz 

+E{g(x(t) ,DQ gT (xt) t) | Y* (0)}de 

HEL —£(2) J[xGO — $(OTi[A(x(0O t) — Allt) Jt 

X R''GD[dyGO — hlæ) ,td | Y* GO) (9.2. 25) 
式 (9. 2. 23) 和 式 (9. 2. 25) 就 是 x(z) 的 最 小 方差 估计 ( 贝 叶 斯 滤波 ) 的 精确 表达 式 , 它 
们 之 间 一 般 是 相互 关联 的 。 


9.3 扩展 卡尔 曼 滤 波 器 


9.3.1 连续 -离散 型 系统 的 扩展 卡尔 受 滤波 器 


实际 问题 中 得 到 的 系统 状态 模型 往往 是 连续 的 ,而 测量 方程 是 离散 的 , 即 
Alt) = f(x) ,2) + wt) (9.3.1) 
x, = h, (x(t,)) +H (9. 3. 2) 
式 (9. 3. 1) 和 (9. 3. 2) 构 成 一 类 有 连续 动力 学 特性 和 离散 时 间 测 量 的 非 线性 系统 。 
下 面 寻 求 这 类 系统 的 状态 xG) 的 最 小 方差 估 值 算法 。 
已 知 ,不 管状 态 向 量具 有 怎样 的 概率 密度 函数 ,最 小 方差 估计 总 是 状态 向 量 的 
条 件 均值 。 假 定 在 tei 时 刻 的 测量 值 刚刚 得 到 处 理 , 相 应 的 条 件 均 值 çC) BAR 
Ho ERTZ i A u 之 间 没 有 测量 ,状态 传播 按 式 (9. 3. 1) 进行。 对 式 (9, 3. 1) 
积分 ,得 





IO = zG@-)+ | fe Dat wode (9.3.3) 
ha tmi 


以 直到 时 刻 t 为 止 所 有 的 测量 值 为 条 件 , 在 方程 (9. 3. 3) 的 两 侧 取 期 望 ,然后 交换 
取 期 望 和 积分 的 次 序 ,再 进行 微分 ,得 


deno] = EAD] a[n) (9.3.4) 


其 初始 条 件 为 
E[x(t1)] = $G.) 
即 在 区 间 tei < t < x E, xG) 的 条 件 均值 是 方程 (9. 3. 4) 的 解 , 可 以 写 为 
EO = xD G. Lth) (9.3.5) 
式 中 “人 ?表示 取 期 望 运 算 。 类 似 于 上 述 过 程 ,将 式 (9. 3. 1) 中 的 x(z) 代入 估计 误 
差 协 方差 阵 
PO) = EL —x(t)] L202) — aT (9. 3. 6) 
交换 取 期 望 和 积分 运算 的 次 序 并 微分 ,得 到 估计 误差 协 方差 阵 的 微分 方程 , 即 
PO = F + fer EHO <i) (9.3.7) 
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式 (9. 3. 5) 和 方程 (9. 3. 7) 是 线性 估计 问题 传播 方程 的 推广 。 如果 E 和 PO) 可 以 
计算 出 来 ,它们 将 提供 测量 时 刻 之 间 状 态 向 量 的 估 值 及 估 值 精度 的 度量 。 
对 于 线性 系统 ,有 了 (x(z) ,t) = SCO 1), 但 是 在 一 般 的 非 线性 情况 下 ,有 


eq, = fed pe dnde, AOD (9.3.8) 


即 如 果 计 算 PCC) ,z) 必须 知道 p(x,t)。 因 此, EO 和 PGD 的 微分 方程 也 取决 于 
XA) 的 整个 概率 密度 函数 p(x,1) 。 

为 了 得 到 实用 的 估计 算法 ,应 该 采用 不 以 了 解 p(x,zt) 为 前 提 条 件 的 计算 均值 和 
协 方差 阵 的 方法 。 为 实现 此 目的 ,最 简单 易 实现 的 方法 是 将 非 线性 向 量 函 数 在 接近 
于 x(D) 的 某 已 知 向 量 处 展开 成 泰勒 级 数 ,尤其 是 取 这 个 已 知 向 量 为 x(z) 的 现时 估 
值 (条 件 均值 ), 即 


fe = feH s+ (9.3.9) 


式 中 ,假设 各 阶 偏 导 都 存在 。 在 式 (9. 3. 9) 两 边 取 期 望 ,得 
Je, 一 CeD 十 0 十 … 
会 去 了 的 短 级 数 中 一 阶 项 以 上 的 各 项 ,并 将 结果 代入 式 (9. 3. 5) , 则 得 Fee, r) 的 一 阶 
近似 , 即 
AOD = f(D DU Lt h) (9.3.10) 
类 似 地 ,将 了 展开 式 的 前 两 项 代 人 式 (9. 3. 6) ,进行 期 望 运算 并 化 简 , 则 得 到 估 
计 误 差 协 方差 阵 的 近似 微分 方程 , 即 
P(O = F), DPA) + PGOFT(eCG0D0 ,1) +Q Cra < t—< tt) (9.3.11) 
AP F(G2(D,b 是 flt) ,oO 相对 于 xCGO 的 Jacobian 矩阵 在 $(O 处 的 值 , BB 
FORG) ,t) 的 第 ij 4263828 


= fx) ,t) 
HADD Az(t) [Jose 


式 (9. 3. 10) ~ (9. 3. 11) 是 状态 条 件 均值 和 相应 协 方差 阵 传播 的 近似 表达 式 。 
由 于 采用 了 泰勒 级 数 展开 方式 对 非 线性 函数 进行 线性 化 ,进而 得 到 类 似 于 线性 系统 
卡尔 曼 滤波 器 的 传播 方程 ,因此 这 种 滤波 方法 称 为 扩展 卡尔 曼 滤波 。 在 非 线性 函数 
的 泰勒 展开 中 ,如 果 取 更 多 的 项 , 则 可 以 推导 出 更 高 阶 且 精度 更 高 的 近似 最 优 非 线 
性 滤波 器 ,如 二 阶 滤波 器 ,这 种 方法 将 在 之 后 讨论 。 

下 面 建立 取得 测量 数据 之 后 的 修正 方程 。 假 定 rO 的 估 值 及 其 误差 协 方差 阵 
已 按 式 (9. 3. 10) 一 (9. 3. 11) 进 行 了 传播 ,在 t, 时 刻 的 解 用 如 ic 和 Pui 表示 。 当 取 
得 测量 值 x 时 ,如 果 要 求 修正 的 估 值 I: 是 测量 值 的 线性 函数 , 即 

$ = a, +K, (9.3.12) 
式 中 ,向 量 a, 和 增益 矩阵 Ks 待定。 


+ 232 + 最 优 估计 理论 





定义 修正 前 后 瞬时 的 估 值 误差 分 别 为 
Xara = Suri — Xr o Xie = Êr — Xk (9. 3. 13) 
将 式 (9. 3. 12) 和 式 (9. 3. 13) 与 式 (9. 3. 2) 相 结合 ,得 到 估 值 误差 如 下 
X,, = a, + K,h, (x) + Kev + The — $i (9.3.14) 


由 于 要 求 估 值 是 无 偏 的 , 即 EC] = 0, 并 认为 Eum] = ELw] = 0, 则 由 
式 (9. 3. 14) 可 得 


G = ie — Kihi (xs) (9.3.15) 
将 其 代 人 式 (9. 3. 12) ,得 
$ = $ +K[z, — Áa Cx) ] (9. 3. 16) 
将 式 (9. 3. 14) 和 式 (9. 3. 15) 结 合 起 来 ,可 得 
Ti = Xia HK e) — Ë, Ga) ] + Ko, (9. 3. 17) 


为 了 决定 最 优 增益 矩阵 K, 可 以 首先 得 到 以 K, 表示 的 估计 误差 协 方差 阵 Pa 
的 表达 式 ,然后 选 K, 使 Pus 的 一 个 适当 的 函数 最 小 。 定 义 
Pir = E[ x, i] 
假定 Pi 与 zx 无 关 , 利 用 关系 式 
Parmi = Elum XI] 
R, = Elvo] 
HARR o, 55 faa 和 x, 统计 不 相关 ,可 以 得 到 
Pin = Parai HKE {Cha (x,) —h Cer) [ha Ga) — ha Ca) JT) KF 
HE Xarea Cha a) —h Cx) } KE 
FKE {Un G) — Ar D rim} 
+KRK] (9. 3. 18) 
定义 代价 函数 


为 了 使 它 最 小 , 令 


J, = [Pa] (9.3.19) 


d 
ƏK, 0 


由 式 (9. 3. 18) 和 式 (9. 3. 19) 得 最 优 增 益 矩 阵 为 
K,=—E(xui[h: Ga) —h Ca) JT) 
X (E[[h,(x,) — Âr Cr) [ba G) — Âr (a) J1] HR} (9.3.20) 
以 上 的 运算 用 到 下 面 一 些 求 导 公式 


9 = Br 
aa tB) B 
ə Tya 
aat BA )=B 


2 a 
aa tr ABA") 24B 
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将 式 (9. 3. 20) 代 入 式 (9. 3. 18) ,得 
P, = Para +K,E([h, (xa) — fa (x1) Yh} (9. 3. 21) 
式 (9. 3. 16)、 式 (9. 3. 20) 和 式 (9. 3. 21) 形 式 上 构成 取得 新 测量 值 时 估 值 的 修正 
算法 。 但 由 于 计算 h(xs) 要 依赖 O 的 概率 密度 函数 ,所 以 这 套 公式 是 不 实用 的 。 
为 了 简化 计算 ,将 hi Oer) 在 $. 处 展开 成 泰勒 级 数 , 即 
hi (x) = h $i) + H, CR) xi — $a) + °° 


r _ Əh (x) 
式 中 H: Cama) 一 ST 本 


将 上 述 级 数 在 前 两 项 以 后 截断 ,然后 把 所 得 的 h, Oa) 近似 式 代入 式 (9. 3.16), 
式 (9. 3. 20) 和 式 (9. 3. 21) ,得 扩展 卡尔 曼 滤 波 器 测量 修正 方程 为 


i = $i + K,[z, — hi Cama )] (9. 3. 22) 
K, = Parm HI (ami ) [H, Cra Pur i HF Caa) + RJ (9. 3. 23) 
Pin = U — KH, (sim ) Py (9. 3. 24) 


式 (9. 3. 10) ~ (9. 3, 11) 和 式 (9. 3. 22) ~ (9. 3. 24) 构 成 非 线 性 系统 在 离散 测量 下 的 
扩展 卡尔 曼 滤波 公式 。 表 9. 1 为 连续 -离散 系统 的 扩展 卡尔 曼 滤 波 公式 一 览 表 。 


表 9.1 连续 -离散 系统 扩展 卡尔 曼 滤 波 公式 一 览 表 

















系统 模型 E) = f(z(0) ,0) H wlt) w(t) 一 N[0,Q(D] 
测量 模型 m = h(z(n)) +w,w ~ NCO, R) 
初始 条 件 z(0) ~ N(o, Po) 
其 他 规定 E[u(0O f J = 0 (对 所 有 的 + 和) 
状态 预测 A) = f) ,7) 
误差 协 方差 预测 PU) = FOW) DPU) + P()FT(2(0),0) +U) 
状态 估计 校正 一 Baja + Kalza — hr Caa )] 
误差 协 方差 估计 校正 | Pai = [1 一 KiHa ama) Pai 
MER K, = Puri HI Chiri) CHa Caji ) Pae HE Cai) HRJ 
ETEC 
定义 FD) = az(t) xz)~2(0) 
— Halala) ) 
| 








9.3.2 离散 型 系统 的 扩展 卡尔 曼 滤波 器 


前 面 从 估 值 满足 估计 误差 方差 最 小 的 条 件 推导 出 具有 连续 状态 方程 和 离散 时 
间 测 量 的 非 线性 系统 扩展 卡尔 曼 滤波 公式 ,但 是 其 传播 方程 式 (9. 3. 10) 一 (9. 3. 11) 
仍然 是 微分 方程 ,这 样 就 使 计算 名 1， 和 Pue 的 难度 大 为 增加 。 

在 实际 应 用 中 ,为 了 便于 计算 机 处 理 ,往往 事先 将 所 获得 的 连续 动态 系统 模型 进 
行 离散 化 处 理 ,而 测量 数据 一 般 是 离散 的 ,这 就 需要 考虑 离散 系统 方程 和 离散 测量 方程 
下 的 扩展 卡尔 曼 滤波 问题 。 下 面 首 先 将 离散 模型 关于 当前 估 值 进行 线性 化 ,然后 直接 
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利用 离散 线性 卡尔 曼 滤波 的 结果 得 出 离散 非 线性 系统 的 卡尔 曼 滤波 公式 。 
考虑 非 线性 离散 时 间 系 统 
Xen = f(x, k) + T,w, (9.3.25) 
Zen = h(xsi sk + 1) 十 wh (9.3.26) 
式 中 , x, An 维 状态 向 量 , z, Am 维 测量 向 量 , w, 和 vi 分 别 为 n 维和 m 维 白 噪声 序 


列 , 且 有 
Eim) = E{w} = 0 


Cov{w wj} = Që ,Cov(m s0} = Rd 
Cov{w suj} = Cov{(Wisxo} = Cov{ wX} = 0 
E{xo} = pC0),Cov{xo ,x ) = P(0) 
在 零 时 刻 ,因为 没有 测量 数据 ,其 状态 估计 和 估计 误差 的 方差 阵 为 
Xolo = pz(0), Poio = P(0) 
假定 在 时 刻 已 得 测量 信息 24 = {zi zz，…zx)》， 则 基于 作对 状态 x, 的 估计 及 估计 


误差 方差 矩阵 为 
Si = E(x, | Zi}, Pa = Cov(x,,x, | Zi) 
对 系统 式 (9. 3. 25) 在 $u, 处 进行 泰勒 级 数 展开 并 忽略 二 阶 以 上 的 高 阶 项 ,得 近 
似 线性 化 状态 方程 为 
Xan = f(x, k) az Kalisk) + Sak) Rus + Tew 
式 中 fa = Ah 
. + 








Tti 


Thlk = x, — fie 


于 是 ,得 状态 的 一 步 提前 预报 和 预报 误差 协 方差 阵 的 近似 方程 , 即 


Sini = E(x, | Z$) ~ farsk) (9.3.27) 
Pen = Cov{Xr sXe | Z!) 
= fa k) Pruf Ek) +T.Q Tt (9. 3. 28) 


同 理 ,将 zm 在 名 ns 处 展 成 泰勒 级 数 并 取 一 阶 近似 ,得 
Zen = 有 (Xe sk + 1) 十 we 


Az hlr k + 1) +h: Ck + 1) Ziri + Urn (9.3.29) 
式 中 , h(k) = Əh(x,a k + 1) 
Xen Ip tinj 
Frai 一 Xin 一 frije 
于 是 ,有 
Benu = Efz | Z) ~ Alen k + 1) (9.3. 30) 
Ee = Cov{zen szen | Zi) 
~ h, (k + 1)Ponuhi Ck + 1) +R (9. 3. 31) 


Senie = Cov{ xin szen | Zi) == Penh I (k + 1) (9. 3. 32) 
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在 & 十 1 时刻, 如果 获得 新 的 测量 zz, 则 xn 的 线性 无 偏 最 小 方差 估计 为 
Sua = E(xsa | Zf) az Efx | za Zt) 
= E{xm | Z) + Seah — ai] 
= fine Km[zm — hlr k + 1)] (9.3.33) 
Pinim = Cov{ Xi sxs | Z) 
Az Paria — Seih SE 
= Pen — Penuhi Ck + 1)[h,(& + DPen k+ DAT CH1) +R, T! 
X h, (k +1)Phak 


= Pen — Kenh, (k + D) Phn (9. 3. 34) 
AP, 
Ken = Sinu = Penh? (k + DLhCk+ DPen lk + DAER) +Re 
(9. 3. 35) 


滤波 初始 值 为 和 io = p, C0) ,Poio = P(O) 

式 (9. 3. 27) RO. 3. 28) \ 式 (9. 3. 33) ~R (9. 3. 35) 构 成 了 非 线性 离散 扩展 卡 
尔 曼 滤波 公式 。 表 9. 2 是 离散 系统 扩展 卡尔 曼 滤 波 公式 一 览 表 。 

应 当 指出 ,对 于 非 线性 系统 ,滤波 增益 阵 K, 和 滤波 误差 方差 阵 Pus 可 以 相对 独 
立地 离线 计算 获得 ,因为 它们 不 依赖 控制 量 和 测量 量 。 但 是 ,对 于 非 线性 系统 的 一 
阶 近似 扩展 卡尔 曼 滤波 ,因为 Puls 依赖 了 C8) ,进而 依赖 各， 即 依赖 实际 的 测量 ， 
所 以 必须 在 线 计算 。 对 于 Xa 和 Sk 也 一 样 。 

一 阶 近似 的 扩展 卡尔 曼 滤波 的 精度 与 系统 模型 的 非 线性 特性 及 噪声 强度 有 关 。 
当 非 线性 函数 在 参考 点 附近 比较 平 直 上 且 信 了 噪 比 较 高 时 ,这 个 算法 可 以 获得 较 精 确 的 
结果 。 如 果 滤 波 精度 较 差 时 ,可 以 考虑 使 用 二 阶 近似 的 扩展 卡尔 曼 滤波 。 


表 9.2 离散 -系统 扩展 卡尔 曼 滤波 公式 一 览 表 

















系统 模型 Tasi = flar k) + yun ua ~ N(0,Q,) 
测量 模型 Zati = hlar k + 1) + uri ~ NCO, Ra) 
初始 条 件 Zz(0) ~ N20, Po) 
其 他 规定 Eurof] = 0 (对 所 有 的 和 j) 
状态 预测 Perie = Re 天) 
误差 协 方差 预测 Paria = fa K) Praf E) +DQ,rT 
状态 估计 校正 feni = Penja + Kine 一 AH 十 1)] 
误差 协 方差 估计 校正 | Poriin = Penja — Kinh (k+ 1) Pha 
增益 矩阵 Keni = Ph (k + 1) [ha (k + D Parsuh I (k + 1) + Rea Jt 
fato = f) 
gx °x == tj 
A.G) = Dak +D 
ren THT tihle 
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9.3.3 连续 系统 的 扩展 卡尔 曼 滤 波 器 


考虑 非 线性 连续 系统 
A) 一 fx) D) Hg) tW) (9. 3. 36) 
z0) = h(x(t) ,0) +> (O (9.3.37) 
有 关 说 明和 假设 条 件 与 式 (9. 2. 15) 和 式 (9. 2. 16) 相 同 。 
假设 在 上 时刻 已 经 获得 系统 状态 x(b 的 滤波 估计 A, 将 f(x(),t) 和 
ACCE) 0) fE E) 附近 线性 化 , 即 非 线 性 系统 将 随时 在 新 估计 的 结果 附近 进行 线 
性 化 。 因 此 ,如 果 估计 误差 足够 小 , 则 线性 化 方法 求 得 的 滤波 方程 会 得 到 满意 的 
结果 。 
HES) t) AA) t) E xG) = $G) 附近 展开 成 泰勒 级 数 , 忽 略 二 阶 以 上 
的 高 阶 项 , 则 得 线性 化 方程 为 


£(t) = fU), +Š RODT) —z£G)]+ g(&G) ,Dw(D 





s" hCG) ,t) 
z(t) = hll), t) + TIG) [x(2) —£(2)]+v (O 


或 +(z) = F(z)xÜ(t) Hult) + G(t)xo(t) (9.3.38) 
alt) = HAX) + yG) +o (t) (9. 3. 39) 
— If) ,t) 
式 中 Fa) ETO 
= ACLl) ,t) 
H(t) = a) 


GO = g0), 
ult) = f(#(1) ,0) — Š EOD ea) 


= — AEU), t) 
ID 一 ACECD D — ge O 


方程 式 (9. 3. 38) 和 式 (9. 4. 39) 与 第 8 章 的 线性 连续 系统 具有 相同 的 形式 , 故 可 
直接 采用 线性 连续 系统 的 卡尔 曼 滤波 方程 。 于 是 ,得 非 线 件 连 续 系统 扩展 卡尔 曼 滤 
波 方程 为 

£G)= FORA) + u(t) + KT) — ye) — HA] 
= f(£(2),2) + K(O[z( — hE) ,2)] (9. 3. 40) 
KO) = POH OR a) 


re ATCR), t) py 
PE) aE R(t) (9. 3.41) 
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PG)= FOPA) 十 PCDFTCGD HEAO GO — KGOORCGOKT(tqO 
fRA) i IEU), 
ERO PO) + PO) FIG) 








HECE) DODE) ,2) — KGORCGEKTT(QO (9. 3. 42) 
初始 条 件 为 
Elto) = $, PC) = Po 

式 (9. 3. 40)— (9. 3. 42) 构 成 了 连续 系统 的 扩展 卡尔 曼 滤波 公式 。 表 9. 3 为 连续 
系统 的 扩展 卡尔 曼 滤波 公式 一 览 表 。 

对 于 非 线性 比较 强 的 系统 ,二 阶 近似 的 卡尔 滤波 器 虽然 能 够 获得 比 一 阶 近 他 扩 
展 卡尔 曼 滤波 器 更 高 的 精度 ,但 是 却 要 付出 更 多 的 计算 代价 。 因 此 ,如 果 系 统 的 非 
线性 不 是 很 强 ,一 阶 近 似 的 扩展 卡尔 曼 滤波 器 还 是 首选 的 非 线性 估计 方法 。 

本 节 讨论 扩展 卡尔 曼 滤波 是 基于 泰勒 级 数 展开 的 线性 化 方法 ,具体 地 说 ,是 将 
系统 模型 中 的 非 线性 函数 f fü 在 当前 的 估计 值 &xx* 附近 进行 线性 化 ,然后 再 利用 
线性 卡尔 曼 滤波 器 的 相应 结果 。 如 果 方法 不 变 ,而 只 是 将 名 改 为 状态 方程 对 应 的 
齐 次 方程 的 解 x" 即 标 称 状态 ) ,得 到 的 非 线 性 滤波 器 称 为 围绕 标 称 状态 线性 化 的 
卡尔 曼 滤波 器 。 一 般 来 说 , 标 称 状态 卡尔 曼 滤波 器 的 精度 比 扩展 卡尔 曼 滤 波 器 的 
差 ,因为 x* 一 般 不 如 名 i 更 接近 于 真实 状态 。 但 由 于 zx* 在 获得 测量 值 之 前 就 已 知 ， 
这 时 滤波 器 的 增益 矩阵 可 以 预先 计算 出 来 ,并 存储 在 计算 机 中 ,所 以 这 种 方法 在 计 
算 机 上 更 容易 编排 。 因 此 ,如 果 滤 波 器 的 复杂 性 和 估计 精度 之 间 需 要 折 中 时 ,可 以 
考虑 这 种 非 线 性 滤波 方法 。 


表 9.3 连续 系统 扩展 卡尔 曼 滤波 公式 一 览 表 














系统 模型 2l) = flialt) ,t) +w) wlt) ~ N[0,Q(t)J 
测量 模型 z(b) = AE) ,) Ho) su) ~ NEO, RO] 
初始 条 件 z(t) ~ NCb, Poa) 
其 他 规定 E[w(t)vT(r)] = 0( 对 任意 的 +: 和 rr) 
状态 估 值 方程 EO = FOW, D + K(D[z() A0] 
误差 协 方差 方程 PG) = F(2(D DPC) + POFA, D +G()Q GT 一 KGDRCDKTCD) 
增益 矩阵 KG) = PWH) DRI U) 
= fD 
td) |z 
ex Mz ,t) 
Hal), 
HG D = ŽE | ,so 











9.3.4 二 阶 近似 的 扩展 卡尔 曼 滤波 器 


对 于 式 (9. 3. 25) 及 式 (9. 3. 26) 描 述 的 非 线性 离散 时 间 系 统 ,假定 上 时 刻 的 状态 
估计 fan 和 估计 误差 方差 阵 P,, 已 经 得 到 ,考虑 
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XeH f Cresk) + fk) Zn 


HD ezhf OX + Tews (9.3. 43) 


RP, f. CR) 的 含义 与 前 面相 同 ,而 e 是 n 维 向 量 空间 尺 " 中 的 第 i 个 标准 向 量 基 , 且 


agp = 2 [9f k) T 
= 0 al dx: ] 








ES 
于 是 , 式 (9.3.27) 和 式 (9. 3. DWR — — 
ñan = fD ++ Dert SL OPa) (9.3.44) 
Pira fa (k)Pauf E Ck) 
+Z: 六 eerets Pau) tr( SL WPi) HIRIE (9.3.45) 


同样 


Zk X Alrik H1) + h,(k+- 1) Xa DThuh® (+ 1D) Tn 十 ea 
i=1 


(9.3.46) 
式 中 , h.(k + 1) 的 含义 同 前 , g, 是 m 维 向 量 空间 R”" 中 的 第 i 个 标准 向 量 基 , 且 
L a [Əh (xa k + 1) 7" 
如 CD 一 让 |... 





为 h(。) R i MAERA C) 对 z, 的 Hessen 矩阵 。 
于 是 , 式 (9. 3. 30)~ 式 (9, 3. 32) 相 应 地 变 为 
han SAn k DHE D strih HDP) — (9.3.47) 
i=l 


Dn h, (k + DPenuhi (k + 1) 


一 工 D> D eel tr{h? (R) P, antr(hR2 (k)) +R (9. 3. 48) 


4 = 
Sii ~ Penuhi (& + 1) (9.3.49) 
而 滤波 方程 为 
fenn = fini HKen [zeh — en] (9. 3. 50) 
Pinen = Pi — Sena Erh (9. 3.51) 
Kn = SiE (9. 3. 52) 


例 9.1 给 定 船舶 的 状态 系统 模型 如 下 
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p = Vy + ScosK +e: 
À = Ve + SsinK +e 
Ve =— We +e: 
Vn =— Wn Hes (9. 3. 53) 
$= 
K=Q+e 
Q =e 
采用 扩展 卡尔 曼 滤波 对 其 状态 进行 估计 。 
在 式 (9. 3. 53) 中 , p 和 4 为 纬度 弧 长 和 经 度 弧 长 ;Vy 和 Vg 为 海流 北向 和 东 向 速 
度 分 量 ; S 为 船舶 相对 于 水 的 速度 ; K 为 舰 船 航向 ; Q 为 舰 船 的 航向 变化 率 。B 为 海 
流 相 关 时 间 , 假 定 为 /7200s。e; 表示 动态 系统 模型 的 系统 干扰 ,为 彼此 独立 的 零 均 
值 高 斯 白 噪 声 ,噪声 的 谱 密 度 和 矩阵 为 
Q = diag{[0. 221,0. 221,0. 0000263,0. 0000263,0. 00159,0. 000908,0] } 
假定 船舶 出 发 时 的 经 纬度 为 (10",45") ,北向 速度 Vy 和 东 向 速度 Ve 均 为 10m/s, 船 
舶 相对 于 水 的 速度 S 为 12m/s, 以 60 的 航向 前 进 , 航 向 变化 率 为 0. 0001°/s。 
对 上 述 船舶 采用 GPS/DR 的 组 合 导航 方式 ,GPS 接收 机 测 得 船 位 的 经 纬度 o, 和 
hp， 罗 经 和 计 程 仪 提 供 航 向 o; 和 航速 Ko, 量 测 噪声 为 零 均值 高 斯 白 噪声 ,方差 阵 为 
R = diag{[10000,10000,0. 0423,0. 0000395]) 
解 由 已 知 条 件 可 知 系统 的 状态 向 量 为 
z=[p A Vn Ve S K QI 


观测 方程 为 z= Hr+v (9.3. 54) 
Po 1, 0: 6 70: 020 办 
| 和 _l|olooo00| | 
m = | E= do 0 1 ool” |w 
Kc 00001 0 


m. 
在 采样 周期 为 1s 的 情况 下 ,对 式 (9. 3. 53) 和 式 (9. 3. 54) 组 成 的 系统 应 用 扩展 卡 
尔 曼 滤波 估计 状态 ,图 9. 1 一 图 9. 3 给 出 了 部 分 估计 的 仿真 结果 。 
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图 9.1 纬度 弧 长 估计 误差 
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图 9.2 经 度 弧 长 估计 误差 
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图 9.3 舰 船 航向 估计 误差 


9.4 基于 统计 线性 回归 的 非 线性 滤波 器 


我 们 知道 , 非 线 性 系统 滤波 的 难点 在 于 预测 部 分 ,即使 假设 干扰 和 噪声 甚至 状 
态 均 符合 高 斯 分 布 ,但 是 如 何 计算 状态 变量 经 过 非 线 性 变换 以 后 的 均值 和 方差 却 是 
个 难题 。 扩 展 卡尔 曼 滤波 (EKF) 是 通过 将 非 线性 函数 在 滤波 值 附近 进行 泰勒 级 数 
展开 并 忽略 二 阶 以 上 项 进行 线性 化 的 ,对 传播 后 随机 量 的 均值 和 方差 只 精确 到 一 
阶 。 因 此 ,对 于 强 非 线性 系统 ,滤波 难以 取得 较 高 的 精度 。 此 外 ,对 系统 方程 线性 化 
时 没有 考虑 系统 状态 和 噪声 变量 的 “概率 传播 "Probabilistic Spread) 问 题 。 

20 世纪 90 年 代 出 现 了 一 类 新 的 非 线 性 滤波 方法 ,这 类 方法 不 是 逼近 非 线性 函 
数 ,而 是 用 样本 加 权 求 和 (Y,Sigma) 直 接 逼 近 随机 分 布 ,并 且 其 测量 更 新 部 分 采用 卡 
尔 曼 滤波 的 更 新 原理 ,所 以 Merwe 将 这 类 方法 统称 为 Sigma 点 卡尔 曼 滤波 器 (Sig- 
ma-Point Kalman Filter, SPKF) 。SPKF 的 特点 是 : 

中 由 于 对 非 线性 函数 的 近似 不 是 采用 泰勒 级 数 展开 的 方法 ,因此 避免 了 对 非 线 
性 函数 进行 解析 求 导 ; 

@ 由 于 考虑 了 概率 传播 问题 ,所 以 对 均值 和 方差 的 逼近 精确 度 提 高 到 至 少 二 阶 。 

SPKF 选择 满足 如 下 要 求 的 Sigma 点 及 相应 加 权 :Sigma 点 应 该 能 够 代表 验 前 
随机 变量 z 的 重要 统计 特性 。 为 满足 这 个 要 求 , 样 本 点 的 选择 需 依据 的 约束 条 件 为 

E< yw >r, p(z)) 一 0 
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AP, < yo > ERARA KERA x: 和 相应 的 加 权 wiG = 1,…,7) 组 成 的 集合 , r 
为 样本 点 的 个 数 , p(z) 为 所 要 估计 随机 变量 z 的 概率 密度 。 实 际 上 ,选择 Sigma 点 
时 ,在 满足 这 样 一 个 约束 条 件 的 同时 还 具有 一 定 的 自由 度 。 例 如 ,通过 使 一 个 形式 
为 <(< grw 二 ,rp(z)) 一 0 的 代价 函数 最 小 化 实现 。 采 用 这 种 代价 函数 的 目的 是 
将 工 某 种 可 取 的 统计 特性 包含 在 内 ,但 不 一 定 满足 , 即 Sigma 点 可 由 如 下 的 最 优 问 
题 给 出 

mine(< Xs 22 r plz)) =0 Subjectto (< yo >>, r,p(z)) = 0 


9.4.1 Unscented 卡尔 曼 滤 波 器 


Unscented 卡尔 曼 滤 波 算法 是 基于 离散 系统 模型 提出 的 ,为 此 考虑 如 下 离散 非 
线性 系统 
x(k+1) = f[xGk)]+ wok) (9.4.1) 
z(&) 一 h[x(k)] + o (k) (9.4.2) 
式 中 , x(k) 为 n 维 的 状态 向 量 , FC.) 为 非 线性 系统 状态 函数 , w(k) 为 系统 的 过 程 品 
声 , 假 定 为 零 均值 高 斯 白 噪 声 ,满足 分 布 nk) ~ N(0,Q(k)) ; =G) 为 测量 值 , hC) 
为 非 线性 观测 函数 , o G) 为 系统 的 测量 噪声 ,满足 分 布 o k) ~ N{0,RCk)) ;状态 
的 初始 值 x(0) 满足 分 布 <(0) ~ N{0,P(0)}。 
对 于 非 线性 系统 (9. 4. 1) 及 (9. 4. 2) 的 滤波 ,关键 在 于 如 何 由 已 知 状态 x(k) 的 均 
ME EC) 和 方差 阵 P. (k) 计算 yA) = flx] 的 均值 CE) 和 方差 阵 P,(k)。 
Unscented 卡尔 曼 滤波 器 (Unscented Kalman Filter，UKF) 是 最 典型 的 SPKF 
H. UKF 假定 状态 满足 高 斯 分 布 ,采用 一 种 称 之 为 Unscented 变换 (以 下 简称 
U -变换 ) 的 技术 近似 非 线性 函数 的 均值 和 方差。 
下 面 以 一 个 一 般 的 非 线 性 变换 
y= f(x) (9. 4. 3) 
为 例 说 明 U -变换 的 原理 。 所 谓 U -变换 ,实际 上 是 一 种 非 线性 近似 技术 , 即 基 于 当 
前 状态 x 的 均值 和 方差 P.， 构造 一 组 固定 数目 的 采样 点 ,利用 这 组 采样 点 的 样本 
均值 和 样本 方差 逼近 非 线 性 变换 y 的 均值 了 和 方差 P, 。 具体 步骤 如 下 ， 
1) 构造 Sigma 点 和 权 值 
构造 2n 十 1 个 Sigma 点 z, 和 相应 的 权 值 W ,WS G = 0,1,2,---,2n) 如 下 


zi=0 
se pm (9.4.4) 

z—(/aFAP,) pi =n+1l, =, 2n 
à/(na+A), i =0 


1/[2(n+å)],i = 1,.,2n (9. 4. 5) 


W° =W}? = { 
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RP, / x 为 矩阵 的 平方 根 ,约定 为 AP- /P. = 已, 这 个 平方 根 可 以 通过 协 方差 
矩阵 的 Cholesky RRA REME IEO RE. OFOP: 中 的 下 标 
i 表示 矩阵 的 第 i 列 , 是 与 x 同型 的 列 向 量 。 1 — a (n +k) 一 n 是 一 个 比例 因子 :a 是 
一 个 尺度 参数 ,决定 着 Sigma 点 在 周围 的 分 布 状态 ,通过 调节 它 可 以 使 高 阶 项 的 影 
响 达 到 最 小 ,一 般 选 择 0 < < < 1。k 为 可 调 参数 ,调整 它 可 以 提高 逼近 精度 。 对 于 高 
斯 分 布 , 当 状态 变量 为 单 变量 时 , 取 “ = 2 ; 当 状 态 变量 为 多 变量 时 , 取 « 一 3 一 mr。 
WP AWP 分 别 为 用 于 计算 样本 均值 和 样本 方差 的 加 权 。 

可 以 计算 , xi(i 二 0,1,2,…,2n) 的 样本 均值 和 方差 分 别 为 和 P,, 因此 可 以 用 
这 组 采样 点 近似 表示 高 斯 状态 x 的 分 布 。 

2)Sigma 点 的 非 线 性 传播 

将 上 面 构造 的 Sigma 点 直接 按照 式 (9. 4. 3) 的 关系 作 非 线性 变换 ,产生 相同 数 
目的 变换 样本 点 Y, , 即 

Y, = f(x) i = 0,1,2,. ,2n (9.4.6) 

3) 计 算 y 的 均值 和 方差 

计算 变换 样本 点 Y:(i = 0,1,2,…,2n) 的 均值 和 样本 方差 ,用 它们 近似 代表 变量 
y 的 均值 和 方差 , 即 


J~ >》 WY (9.4.7) 
0 


2" . 
P, ~ X WP (Y, —y) (V, —y)T (9. 4.8) 
图 9.4 是 U -变换 过 程 的 原理 图 。 


x 的 分 布 城 >O) 





Sigma 点 变换 后 的 
Sigmaiz Ezec 





图 9.4 DU -变换 的 原理 图 


UKF 的 结构 与 卡尔 曼 滤波 的 相同 ,也 是 分 为 两 个 步骤 ;预测 (时 间 更 新 ) 和 更 新 
(测量 更 新 ) 。U -变换 的 过 程 实际 上 就 是 UKF 的 时 间 更 新 过 程 。 假 设 已 知 状态 在 
上 一 时 刻 的 状态 估计 值 和 方差 阵 为 &(R 一 1) 和 卫 -( 一 1D), 则 对 非 线性 系统 (9. 4.1) 
及 (9. 4. 2) 采 用 UKF 进行 滤波 的 具体 步骤 如 下 : 
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(1) 设 定 初 值 。 
(0) = E[x(0)],P(0) = E{[x(0) 一 人 0)] [x(0) 一 人 0)J7) (9.4.9) 
D 时 间 更 新 。 
QO £ > 1 BF, 按照 式 (9. 4. 4) 构 造 2n 十 1 个 Sigma 点 , 即 
Xk—1) = {2(R 一 1) ,2 一 1) +[ VG FOP, G — 1] 
AR 一 1) 一 [VC 二 ECR 一 1 本 )Gi 一 1,2，72) (9.4.10) 
@ 计 算 预测 Sigma 点 , 即 


XQ) = f[y,Gk —1)]G = 0,1,2,---,2n) (9.4.11) 
@ 计 算 预 测 Sigma 点 的 均值 和 方差 , 即 
> 

£ GQ) = PD Wxr Ck) (9. 4.12) 
=i 


2n 
Pi(R) = DWP Q) — £ K] er Q) — £ TTH) (9.4. 13) 
名 


(3) 测 量 更 新 。 
当 获 得 新 的 测量 值 (8) 后 ,利用 下 面 一 组 公式 对 状态 均值 和 方差 进行 更 新 。 


Ek) = E Ck) KEk) — £ (k)] (9. 4.14) 
P. (k) = P; (k) — KP, (k)K" (9. 4, 15) 
K = P.. (k)P7' (k) (9. 4. 16) 

式 中 ， 
£ (k) = > WP [x Ck)] (9.4.17) 

= 


2n 
P = XWP (hEr E] — £ (CD (hEr k] — £ Ck) HRC) 
名 
(9. 4. 18) 
Pa (k) = Swe GQ) — £ QD) {hlxr (8)]—2 (DJ)T (9.4.19) 


扩展 卡尔 曼 滤 波 是 通过 对 非 线性 方程 进行 阶 泰勒 级 数 展开 而 进行 线性 化 的 ， 
非 线性 逼近 精度 为 一 阶 , 而 经 过 分 析 可 知 ,UKEF 算法 可 以 使 均值 精确 到 三 阶 ,方差 精 
确 到 二 阶 。 

综 上 所 述 ,UKF 与 EKF 相 比 具有 如 下 的 优点 : 

(1D 不 需要 计算 非 线性 函数 的 Jacobi 矩阵 ; 

《2) 可 以 处 理 不 可 导 的 非 线 性 函数 ; 

(3) 计 算 量 与 EKF 相当 ; 

(4) 对 高 斯 输入 的 非 线性 函数 近似 时 ,使 均值 精确 到 三 阶 ,方差 精确 到 二 阶 。 

例 9.2 利用 UKF 设计 基于 修正 罗 德 里 格 参数 (Rodrigues Parameters) 的 卫星 
姿态 估计 器 。 





。244 。 最 优 估计 理论 





(1) 动 态 方程 和 观测 方程 。 
设 姿态 四 元 数 为 4 = [ga q, J" = [sin(0/2)ñ cos(0/2)]! , 则 MRPs 定义 为 


=% __sin(O2) a 
6= Ta To/ 0A 


式 中 ,p 二 [p，pz m0 MA DARRIE ARAE E. 
由 MRPs 表示 的 姿态 运动 学 方程 为 
p= a-p 十 2[p X] + 2p" yw 


式 中 , 1 为 三 维 单位 矩阵 , o= [wx w。 wsJ 为 星体 的 三 轴 角 速度 , [p Xj] 为 p 的 
斜 对 称 矩 阵 。 
从 MRPs 到 四 元 数 的 转化 通过 下 式 实 现 , 即 





1 2p 
r= Arh Sa 
在 没有 陀螺 提供 角速度 的 条 件 下 ,需要 利用 飞行 器 的 姿态 动力 学 方程 
ó = J'(N—L[e XJ](Jeo)} 
式 中 , o = [o w。 wsJ 为 飞行 器 体 坐 标 系 中 的 三 轴 角 速度 ;J 为 系统 的 惯量 矩 
BE; N 为 外 部 力矩 。 
在 姿态 估计 器 中 ,状态 变量 选 为 六 维 向 量 x 二 [pr or], 则 状态 方程 为 
e) = [ff f: J! Hwa) 
RP, fi = p, fs = ó ; we) 是 过 程 噪 声 , 且 wa) ~ N[0,Q(01, 
姿态 测量 方案 采用 基于 星 敏感 器 的 双 矢量 观测 ,离散 观测 方程 为 
i An], 
(pe) rs 
AP, ri(i = 1,2) 表示 第 i 个 观测 值 在 飞行 器 参考 坐标 系 上 的 投影 值 , 且 r, 与 r 非 
平行 ; vi 为 观测 噪声 ,满足 分 布 w ~ N(0,R) .4(p) 为 用 户 表示 的 姿态 矩阵 
P 
ht 
(2) 初 始 值 与 参数 设置 。 
真实 的 状态 初始 值 ; 
po) = tan (5 )[ L l 1 ] ,oo =15X[0.3 0.4 0.3J"C/b) 


V3 V3 3. 
初始 状态 估 值 : 
pO) 一 [0 0 o,ao) =[0 0 ojrCyb) 
初始 误差 方差 : 








(CPA 0a ] 


PCO =[ " 
5L os G.28/25 
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过 程 噪声 密度 矩阵 : 
Q= (0531, 
离散 采样 时 间 间 隔 : 
T=0.5s 
矢量 观测 噪声 标准 差 : 
au 一 20” 
两 个 参考 矢量 : 
n=[1 0 0]7， 关 =[0 1 0f 
惯量 矩阵; 
49.96 2.68 0.24 
| 4.7 55.40 nze |as nò 
0.24 0.24 63.00. 
(3) 仿 真 结果 。 


图 9.5 是 估计 的 姿态 误差 角 : 滚 动 角 、 俯 仰角 和 偏 航 角 。 以 误差 曲线 看 ,在 80s 
处 滤波 已 完全 收敛 , 稳 态 误差 幅 值 在 3 一 5 角 秒 之 间 , 相对 于 原始 观测 精度 (20 角 
秒 0) 提 高 了 4 倍 左右 。 图 9. 6 是 三 轴 的 角速度 估计 误差 曲线 ,在 100s 左右 达到 收 
剑 , 稳 态 误差 幅 值 在 2 一 10("/b) 之 间 。 





事态 角速度 误差/(“/s) 

















-0 
0 有 10 150 200 250 300 350 400 440 300 
时 间 /s 


时 间 /s 
图 9,5 姿态 角 估计 误差 图 9.6 姿态 角速度 估计 误差 


9.4.2 ”中心 差分 卡尔 曼 滤波 器 


与 UKF 的 思路 不 同 的 是 ,中 心 差分 卡尔 曼 滤波 (Central Difference Kalman Fil- 
ter,CDKF) 借 助 Sterling 插值 公式 ,用 多 项 式 允 近 非 线性 函数 的 导数 , 它 采 用 中 心 差 
分 代替 Taylor 展开 中 的 一 阶 和 二 阶 导数 ,从 而 避免 复杂 的 求 导 运 算 。 虽然 这 种 方法 





D 角 秒 : 角 单 位 ,1 角 秒 一 度 /3600 
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不 是 直接 在 统计 线性 回归 的 理论 基础 导出 的 ,但 它 隐 含 地 应 用 了 基于 线性 化 加 权 的 
统计 回归 方法 。 对 于 维 的 状态 向 量 ,CDKF 的 Sigma 点 的 个 数 也 为 2 十 1。 

对 于 式 (9. 4. 3) 中 的 非 线性 函数 y = f(x), 考虑 其 多 项 式 逼 近 , 即 如 下 形式 的 二 
阶 展开 








I= SD HASDA) las FEAOG) |,—, (9. 4. 20) 

称 之 为 Sterling 插值 公式 ,其 中 ， 
fax) = FEED G (9.4.21) 
faw = fet D Efa NEN 


分 别称 为 一 阶 中 心 差分 和 二 阶 中 心 差分 。 

式 (9.4 20) 实 际 上 就 是 在 泰勒 展开 中 以 中 心 差分 替代 其 中 的 导数 。 由 于 中 心 
差分 计算 只 依赖 非 线性 函数 在 具体 位 置 上 的 值 ,因此 便于 计算 。 

为 了 使 Sigma 点 具有 与 真实 状态 分 布 相同 的 均值 ,方差 和 高 阶 中 心 矩 ,构造 sig- 
ma 点 和 相应 权 值 如 下 


ži =0 
x = x+ (VRP) i = 1, n (9. 4. 23) 
3— (VEP)i,i= nt+l,,2n 


Eri =0 
w= (9. 4. 24) 





zi =1,,2n 


式 中 ,h 是 大 于 等 于 1 的 尺度 参数 ( 即 中 心 差 分 的 半 步 长 ) , 它 决定 了 Sigma 点 在 验 前 
均值 附近 的 分 布 ,其 最 佳 值 应 与 先前 随机 变量 峰值 的 均 方 根 相 对 应 ,对 于 高 斯 分 布 
的 最 佳 值 为 V3 。 
应 用 CDKF 对 非 线性 系统 (9. 4. 1) — (9. 4. 2) 进 行 滤波 的 具体 步骤 如 下 ， 
(1) 设 定 初 值 。 
£0) = E[x(0)],P(0) = E([x(0) —$(0)] [x(0) 一 4(0)]r7) (9.4.25) 
(2) 时 间 更 新 。 
@ 当 上 之 1 时 , 按照 式 (9. 4. 23) 构 造 2* 十 1 个 Sigma 点 , 即 
XR—1) = ($z —1),£G—1)+[/BE D], 
ik= D —[ VE P.G 1 1)G = 1,2,..,n) 
@ 计 算 预 测 Sigma 点 , 即 
XQ) = flak- 1], Gi=0,1,2,,2n) (9.4.27) 


(9.4.26) 
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@ 计算 预测 Sigma 点 的 均值 和 方差 , 即 
2n 

£ G) = D War Q) (9. 4. 28) 

P; (k) = Yw. Q —£ G)][xzr G) — £ kT HOC) (9.4.29) 


(3) 测量 更 新 。 
当 获 得 新 的 测量 值 z() 后 ,利用 下 面 一 组 公式 对 状态 均值 和 方差 进行 更 新 。 


£(k) = (k)+K[z(k) —2 Ck] (9. 4. 30) 
P.(k) = P; (k) — KP.(k)KT (9. 4. 31) 
K = Ps GP; (k) (9. 4. 32) 
AH, 
2n 
£ Q) = D Wahler QD] (9.4.33) 
= 


2n 
P.G) = DIW: hlar kD] — E GQ)) (Alg )]— £ Ck))T HRC) 
= 
(9. 4. 34) 
2n 
Pa Ck) = DP W(x k) — E QD) (Ala JE Ck))T (9.4.35) 
= 


在 理论 上 ,CDKF 能 获得 比 UKF 更 高 的 精度 ,但 在 实际 应 用 中 ,二 者 的 性 能 是 
等 同 的 。 


9.5 粒子 滤波 器 


由 9.2 节 的 内 容 可 知 , 贝 叶 斯 估计 需要 计算 整个 状态 空间 的 积分 ,对 于 非 高 斯 的 
非 线性 系统 ,几乎 无 法 获得 其 解析 解 ;9. 3 节 介 绍 的 EKF 虽然 简单 易 行 ,但 是 当 系统 
的 非 线性 比较 强 时 ,对 系统 状态 的 估计 精度 会 降低 ;9. 4 节 介绍 的 UKF 和 CDKF 虽 
然 在 估计 精度 和 鲁 棒 性 比 上 EKF 高 ,并 且 计算 量 相当 ,但 是 它们 同样 需要 满足 高 斯 
分 布 。 在 实际 应 用 中 ,很 多 系统 是 强 非 线性 的 ,而 且 其 状态 未 必 满 足 高 斯 分 布 , 即 非 
线性 非 高 斯 的 情况 。 针 对 这 种 情况 ,基于 蒙特 卡 洛 (Monte Carlo) 采 样 方法 和 贝 叶 斯 
最 优 估计 理论 基础 上 提出 了 粒子 滤波 (Particle Filtering, PF) 方 法 。 

PF 又 称 为 基于 滤波 的 非 格子 (Grid-less) 模 拟 、 凝 聚 算法 (Condensation Algo- 
rithm) \ 序 贯 蒙特 卡 罗 (Sequential Monte Carlo, SMC) 3} J} 叶 斯 导 引 滤波 (Bayesian 
Bootstrap Filtering). PF 利用 一 组 加 权 的 随机 样本 (粒子 ) 逼 近 状态 的 后 验 概率 密 
度 , 是 一 种 通过 非 参 数 化 的 蒙特 卡 洛 模拟 实现 递 推 贝 叶 斯 估计 的 算法 。 随 着 粒子 数 
目的 增加 ,粒子 的 概率 密度 函数 逐渐 逼近 状态 的 概率 密度 ,粒子 滤波 即 达到 了 最 优 
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贝 叶 斯 估计 的 效果 。 相 对 于 前 面 介绍 的 诸多 非 线性 估计 方法 来 说 ,粒子 滤波 算法 能 
够 处 理 任意 非 线性 和 非 高 斯 系统 的 估计 问题 ,并 且 具 有 概率 意义 上 的 收 伍 性 。 
1. 样本 重要 性 重 采样 方法 
样本 重要 性 重 采样 (Sampling Importance Resamping,SIR) 是 蒙特 卡 洛 方法 中 一 种 
常用 的 采样 技术 ,原理 是 :在 采样 过 程 中 , 如果 目 标的 概率 分 布 p( 不 可 知 或 难以 采 
样 , 则 可 以 从 一 个 与 目标 概率 分 布 相似 是 容 易 采样 的 概率 分 布 <(D) 中 进行 采样 。 
考虑 如 下 的 非 线性 系统 
x(k + 1) = f[x(k), wk)] (9. 5.1) 
z(k) = h[xCk) ,wv (&)] (9. 5. 2) 
RH, FO ft hC) 是 非 线性 函数 , w(k) 和 wv O 为 系统 状态 噪声 和 观测 噪声 。 
BE = [% xu] 为 从 0~ 时 刻 所 有 状态 向 量 的 集合 ,过 = [s zra] N 
从 1 一 时 废 所 有 观测 向 量 的 集合 。 滤 波 过 程 中 利用 夫 和 车 获得 最 优 的 xi B 
EU[xCD]) = | FEOJ) | tlar 


一 般 而 言 , pLx(&) | 21] 是 多 变量 且 非 高 斯 的 ,很 难 直接 采样 ,可 以 用 与 其 近似 的 分 
布 rLx(&) | zf] 代替 它 进行 采样 , 则 


By[x(D]= | AxA) | tdr) 


= [i=] AD Ls tao | zt]dx(k) 


= [arw E EE JECO CeCe) | ddzc) 








= rceo] rx) | #]JdxCk) (9.5.3) 
式 中 , x[x(k) | i) 称 为 重要 性 函数 ,而 
— pii | x(&)Jp[Lx(k)] 
e[xC&)] FETO SEN, (9.5.4) 


称 为 重要 性 权 值 。 
式 (9. 5. 3) 还 可 以 写 为 
Ef[xGQ)J= pe [ADIT | tdr 
[ADAD Jl) | sdr(b 


[ala 1 xpi 下 | 下 uc 


[ADDR | dtJdr(h) 
atx Tnx 0) | ddxCh) 
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Erwt) f[x(k) Jo[x(&) J) 
x Eroi (Lrce)]} 
可 见 , 如 果 在 时 刻 以 分 布 x[x(k) | A] 采 N 个 粒子 Di = 1,2,---, N, WJ 
SEE] 的 数学 期 望 可 以 近似 表示 为 


(9.5.5) 


FoI] 


E( f[xG)J)== E: 
NLW] 
= FSD] (9.5.6) 
式 中 
aln] =] _ (9.5. 7) 
ALe] 


为 归 一 化 的 权 系数 ,以 下 简写 为 o, O), 

可 见 , 如 果 想 得 到 状态 x(k 十 1) 的 最 优 估计 ,可 以 按照 重要 性 函数 x[x(k) | 27 
采样 粒子 集 Dx: C) sw (k) Jri = 1,2,…,NN, 通过 粒子 集 的 非 线性 变换 的 加 权 平 均值 
得 到 。 如 果 粒 子 的 数量 六 足够 大 ,那么 估计 结果 接近 最 优 贝 叶 斯 估计 。 但 是 ,样本 
重要 性 采样 方法 在 计算 a[x(%)] 时 ,需要 考虑 过 去 时 刻 所 有 观测 z: 的 影响 ,这 显然 
会 增加 计算 时 的 存储 量 , 尤其 是 数据 较 多 时 ,存储 和 计算 的 压力 更 明显 。 为 了 避免 
这 种 情况 ,有 人 提出 了 序 贯 重要 性 采样 方法 。 

2. 序 贯 重要 性 采样 方法 

序 贯 重要 性 采样 方法 (Sequential Importance Sampling, SIS) 是 最 基本 也 是 目前 
应 用 最 广泛 的 粒子 滤波 方法 。SIS 是 一 种 通过 蒙特 卡 洛 模拟 实现 贝 叶 斯 滤波 器 的 技 
术 , 核 心思 想 是 利用 一 系列 随机 样本 的 加 权 和 所 需 的 验 后 概率 密度 得 到 状态 的 估计 
值 。 当 样本 点 的 数量 无 穷 多 时 ,蒙特 卡 洛 特性 与 验 后 概率 密度 的 函数 表示 等 价 ,SIS 
滤波 器 近似 于 贝 叶 斯 滤波 器 。 

考虑 到 状态 演化 和 观测 条 件 的 相对 独立 性 ,通常 认为 状态 2 具有 马尔 可 夫人 性 ， 
z《k) 仅 与 x(k) 相关 ,那么 有 

z[x(&) | z] = z[zG&) | xz(E 一 1),z]x[x(E 一 1) |24] — (9.5.8) 
加 [对 | x(k)] = plzCk) | xk) Jp | xCk—1)] (9. 5.9) 
将 以 上 两 式 代入 重要 性 权 值 公式 , 则 w[x(&)] 可 以 写 为 


_ pd Ww] 
x= | 2] 


PEH) | xJ | xk DJA | x@ DJk] 
x(k) | xk- Dst dxe D | #1J 
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DEH) | xQ) Jp[xCk) | xk — DJ 
olx(h— DJ Bs E T] (8. 5. 10) 


可 见 ,在 适当 选取 重要 性 函数 x[x(k) | x(k — 1) szi] 的 基础 上 ,可 通过 贝 叶 斯 体系 中 
的 时 间 更 新 和 观测 更 新 步骤 ,以 序 贯 更 新 重要 性 权 值 : 对 于 重要 性 函数 =[xC&) | 
x(&— 1),z 匀 ， 如 果 能 够 从 目标 验 后 概率 密度 plk) | 地] 采样 出 N 个 粒子 
[xi(k)],i = 1,2,---., N, 则 可 以 用 经 验 概率 分 布 以 近似 验 后 概率 密度 


N 
z[x(&) | zt] = Dyw ax) — x: Ck) ] (9.5.11) 
= 


式 中 , 6(.) 为 Dirac 函数 。 

3. 重要 性 函数 的 选择 

由 以 上 的 推导 过 程 可 见 , 粒 子 滤波 方法 的 滤波 质量 主要 取决 于 两 方面 : 

@ 重 要 性 函数 和 目标 概率 分 布 是 否 接近 ; 

@@ 经 验 概率 分 布 是 否 已 经 足够 地 表示 了 目标 概率 分 布 。 

前 者 主要 依赖 重要 性 函数 的 选择 或 是 采样 算法 的 本 身 ,而 后 者 与 再 采样 步骤 的 
粒子 多 样 性 有 关 。 对 于 重要 性 函数 的 选择 有 多 种 方法 ,通常 的 原则 是 重要 性 权 值 的 
方差 最 小 。 

可 以 证 明 , 在 给 定 x(k — 1) 和 对 的 情况 下 ,能 使 重要 性 权 值 方差 最 小 化 的 最 优 
重要 性 函数 为 





z[x(&) | xCk—1),z] = p[x(&) | x(k—1),zt] (9. 5. 12) 
4. 基本 粒子 滤波 器 步骤 


基本 粒子 滤波 包括 样本 重要 性 采样 和 再 采样 ,结合 贝 叶 斯 滤波 体系 的 时 间 更 新 
和 观测 更 新 两 步骤 进行 ,具体 算法 步骤 如 下 。 


(1) 初始 化 : :一 0, 
DM i= 1,2,…,N, 按照 初始 重要 性 函数 x[x(0)] 选取 初始 粒子 群 
Ca: CO) Jior, Ne 
MiS 1,2,…,N, 估计 初始 粒子 的 重要 性 权 值 
au[xi(0)] = ZEO | x.(0) Je[x (0) (9.5.13) 


=[x,(0) | z(0)] 
@ 从 i 二 1,2,…,NN, 归 一 化 初始 重要 性 权 值 


a (0) = 0O] (9.5.14) 
2 e[x,(0)] 
(2) 时 间 更 新 : =k 1l, k >l, 
A i=1,25 N, 按照 重要 性 函数 alr (A) | z1), ERER A 
RTE eDane Bx) = flek] 
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(3) 观测 更 新 : t 二 k, 
@ 从 i 二 1,2,…,NN, 在 已 获得 z(&) 的 情况 下 ,估计 重要 性 权 值 系数 


PEZH) | x; (0) Jp[x; QO) | xk — 1)] 
oln] = alk- D] alek) | xG — Dz] 519 


@ 从 i 二 1,2,…,N, 归 一 化 重要 性 权 值 
wk) = EE] 


DICEZ 





(9. 5. 16) 


(4) 重 采样 。 

@ 从 i 二 1,2,…,NN, 根据 权 值 o (k), 分 别 复制 高 权 值 粒子 ,舍弃 低 权 值 粒子 ， 
从 而 重新 产生 N 个 粒子 集 [x GA) 12 o 

@ K i= 1,2,…,NN, 归 一 化 权 值 


zL 
mk) = Ñ (9. 5.17) 
(5) 输 出 结果 。 
N N 
XA) = Dyr nk) | A] = Dyak) — xQ] (9. 5.18) 
= = 
转 至 步骤 (2) 。 


基本 粒子 滤波 的 原理 示意 图 如 图 9. 7 所 示 。 


TRA 
NN A Q 1 Í 


n|x(k)ya(k-1)z0] 





4i 1 1 Z= 
= | # Il. 

图 9.7 基本 粒子 滤波 原理 示意 图 

9.6 统计 线性 化 滤波 器 
在 9. 3 节 中 ,通过 截取 泰勒 级 数 展开 式 的 方法 近似 非 线性 函数 ,并 由 此 导出 若干 


种 近似 的 最 优 非 线性 滤波 器 。 一 种 比 泰勒 级 数 展开 更 精确 的 方法 是 统计 近似 法 。 
考虑 由 下 列 级 数 展开 的 形式 逼近 非 线性 函数 f(x) , 即 
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fO) az m +n x + n 22 + + + nx" (9.6.1) 
定义 误差 
e = f(x) — no — "° —n,x” 
希望 选取 的 n, , 能 使 近似 误差 在 某 种 “平均 ”的 意义 下 最 小 。 能 够 实现 此 目的 的 任何 
一 种 基于 x 统计 特性 的 方法 都 可 以 看 作 是 统计 近似 方法 。 

确定 式 (9. 6. 1) 中 系数 的 最 常用 方法 ,是 使 e 的 其 均 方 误差 最 小 , 即 要 构造 一 个 
量 Ele], 使 之 对 每 一 的 偏 导 为 0, 从 而 得 到 一 组 关于 系数 n, 的 线性 代数 方程 ,这 
些 方程 可 以 用 x 和 f x) 的 矩 和 交叉 矩 求 解 。 

可 以 看 出 ,基于 统计 的 非 线性 近似 法 比 泰 勒 级 数 展开 法 有 一 个 明显 的 优点 是 它 
KER f(x) 的 导数 存在 。 这 样 , 大 量具 有 本 质 非 线性 特性 的 系统 ,如 继 电 型 .饱和 
型 和 门限 型 等 系统 都 可 以 采用 这 个 方法 处 理 。 另 一 方面 ,由 于 方程 有 期 望 运算 ,这 
就 要 求 已 知 z 的 概率 密度 函数 ,这 是 统计 近似 法 一 个 明显 的 缺点 。 实 际 上 ,用 于 计 
算 系数 的 概率 密度 函数 一 般 可 以 用 近似 的 方法 获得 。 因 此 , 非 线 性 统计 近似 法 对 于 
设计 非 线性 滤波 器 来 说 具有 更 优良 的 性 能 。 

以 下 介绍 非 线性 向 量 函 数 f(x) 展 成 式 (9. 6. 1) 形 式 级 数 时 只 取 前 两 项 的 计算 ， 
即 统计 线性 化 方法 ,并 由 此 构造 类 似 于 扩展 卡尔 曼 滤波 的 算法 。 

考虑 用 以 下 线性 函数 形式 来 逼近 非 线性 函数 f(x) 


fx) 之 十 Nm (9. 6. 2) 
式 中 ,a 和 Ny 是 待定 的 向 量 和 和 矩阵。 定义 误差 为 
e= f(x)—a— Nx (9. 6. 3) 
选取 合适 的 a 和 Ny, 使 
J = E[e" Be] (9. 6.4) 


最 小 。 其 中 ,B 为 某 个 对 称 半 正定 矩阵 。 
将 式 (9. 6. 3) 代 入 式 (9. 6.4) ,并 令 本 对 于 a 的 元 素 的 偏 导数 为 0, 得 


ELB. f(x) —a — Nx)] = 0 (9.6.5) 
H B 为 任意 的 对 称 半 正定 矩阵, 可知 
a = f(x) — Nr (9.6.6) 


式 (9. 6. 6) 中 ,了 (x) 中 的 符号 ( ) 表示 期 望 运算 。 将 式 (9. 6. 6) 代 入 式 (9. 6. 4) ,并 
取 其 关于 N, 元 素 的 偏 导 ,得 


E(B[Ny£ x! + (f(x) — f(x)) £1J) = 0 (9.6.7) 
RH, z = x— x. 解 上 述 方程 ,得 
N, = [fx] x" Pp (9. 6. 8) 


式 中 ,PP 为 x 的 协 方差 矩阵 。 
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由 式 (9, 6. 6) 和 式 (9. 6. 8) 给 出 的 a 和 N , 都 与 加 权 和 矩阵 B 无 关 ,因此 它们 给 出 
了 了 广义 上 的 最 小 均 方 误差 近似 。 如 果 和 x 都 是 零 均 值 的 标量 , 则 Nj 为 标量 
ny 一 | (9. 6. 9) 
nf 表示 当 输 入 是 零 均值 的 随机 变量 时 ,一 个 奇 函 数 非 线性 特性 描述 函数 增益 。 
下 面 举例 说 明 统计 线性 化 方法 比 泰勒 级 数 展开 的 优越 之 处 。 考 虑 图 9. 8 中 的 饱和 非 
线性 系统 ,如 果 将 f(x) 在 原点 x = 0 处 展开 成 任意 阶 泰勒 级 数 ,将 得 到 
fG) = x (9. 6. 10) 
出 现 这 种 结果 是 由 于 了 一 阶 导数 的 不 连续 性 ,饱和 效应 完全 消失 了 。 反 之 ,如 果 应 
用 统计 线性 化 方法 , 则 有 
S az nx (9. 6. 11) 
式 中 , ny 为 下 式 定义 的 描述 函数 增益 , 即 
EE 
a aden: IEO 
| trwa 
式 中 , p(x) 是 x 的 概率 密度 函数 。 如 果 假 定 z 为 高 斯 型 随机 变量 , 即 
p(x) = (9. 6. 13) 
将 式 (9. 6. 13) 代 入 式 (9. 6. 12), 并 计算 图 9. 8 所 示人 饱和 函数 的 nj, 则 得 如 图 9. 9 所 
示 的 结果 。 显 然 , ny 是 f(x) 的 线性 部 分 进入 饱和 区 的 点 5 及 x 标准 偏差 的 函数 。 
描述 函数 的 重要 性 在 于 它 考虑 到 x 可 能 处 于 饱和 区 的 概率 。 
下 面 将 统计 最 优等 级 数 逼 近 非 线性 函数 f(x) 的 方法 与 9. 3 节 的 结果 相 结 合 , 导 
出 近似 的 最 小 方差 滤波 算法 。 
将 式 (9. 6. 6) 代 人 式 (9. 6. 2) ,得 
Fœ) == Fx) +N, x E) 
基于 统计 线性 化 方法 与 描述 函数 理论 的 联系 ,这 里 称 N, 为 描述 函数 增益 矩阵 。 一 般 来 
说 , 了 是 时 间 的 函数 ,而 由 式 (9. 6. 8) 计 算出 的 N, 也 是 时 间 的 函数 ,因此 可 将 上 式 写 为 


(9. 6. 12) 





Ft) az Ft) HN 0) (x — x) (9. 6.14) 
同样 将 离散 测量 非 线性 方程 表示 为 
hi (x, ) == h, (x, ) + N, (&)(x, — Fe) (9. 6. 15) 


ACO. 6. 14) 一 式 (9. 6. 15) 中 , FAN, AN, 都 是 待定 量 。 在 理论 上 ,这 些 量 都 取决 于 
x 的 概率 密度 苞 数 p(x), 而 p(x) 一 般 不 易 求 得 。 为 此 ,假定 x 是 高 斯 型 的 ,一 方面 由 于 其 
概率 密度 函数 可 完全 由 其 均值 和 方差 决定 , 另 一 方面 这 两 个 量 也 是 滤波 算法 中 需要 计算 
的 部 分 。 

假定 方程 (9. 6. 14) 和 (9. 6. 15) 的 右 侧 都 是 x 在 假定 的 情况 下 计算 得 出 的 ,于 是 
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可 将 f 和 hs 的 统计 线性 化 代 人 连续 一 离散 型 的 扩展 卡尔 曼 滤 波 方程 ,并 进行 指定 的 
期 望 运 算 , 得 非 线性 滤波 方程 如 表 9. 4 所 示 。 








(a) 饱和 非 线性 (b) 描述 函数 
图 9.8 人 饱和 非 线性 的 描述 函数 








图 9.9 对 标量 奇 函 数 非 线性 的 描述 函数 近似 
表 9.4 统计 线性 化 滤波 器 公式 




















系统 模型 A) = f[z(G0),r] Hwe) wl) ~ NOQG) 
测量 模型 [a = Mlz] = ww ~ NOR) k= 1,2, 
初始 条 件 z(0) ~ Nzo, Po) 
其 他 假设 ELW] = 0 (对 所 有 的 有 和 所 有 的 +) 
状态 估 值 传播 a) = Falt) ,) 
误差 协 方差 传播 PG) = Ny(O PG) PONE) +U) 
描述 函数 计算 NO = [FT -FIPO 
状态 估 值 修正 mG) = B) + Kaila — 所 (zm)] 
误差 协 方差 修正 PÐ = [I— KN, JPI) 
增益 矩阵 计算 Ki = P (NE Ck) [Ns C Pa (NE C) + R, T: 
描述 函数 计算 NMH = aaO AO -hla OOP 
ax TETTA z 38 z — NE, P) 时 计算 的 期 望 值 
hom C) Ahala ORTO 是 假定 zx( 一 ) ~ NIR C—), Pa] 时 计算 的 期 望 值 
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应 该 指出 ,因为 期 望 运算 必须 相对 于 所 假设 的 x 的 高 斯 密度 函数 进行 ,所 以 统 
计 线 性 化 滤波 器 的 计算 量 要 大 于 对 非 线 性 系统 进行 泰勒 展开 而 导出 的 滤波 器 。 但 
是 ,对 于 一 些 本 质 非 线性 系统 ， za AE O EEEIEE 
算是 值得 的 。 


9. 7 非 线性 预测 滤波 器 


在 前 面 介 绍 的 非 线性 滤波 方法 中 ,一 般 假定 系统 的 模型 准确 , 且 状 态 方程 的 干 
扰 项 或 模型 误差 一 般 假定 为 高 斯 白 噪声 。 在 实际 应 用 中 ,一 方面 系统 模型 会 含有 一 
定 的 建 模 误差 ,有 时 这 种 误差 可 能 会 很 大 ; 另 一 方面 ,模型 误差 未 必 符 合 高 斯 分 布 的 
特性 ,甚至 是 统计 特性 未 知 的 。 这 时 ,如 果 按照 高 斯 白 噪声 的 假定 使 用 滤波 ,会 产生 
较 大 的 估计 误差 ,甚至 使 滤波 发 散 。 最 小 模型 误差 (Minimum Model Error, MME) 
准则 及 估计 方法 就 是 用 于 解决 这 种 情况 而 产生 的 ,但 因为 是 一 种 后 处 理 方法 ,并 且 
不 容易 实现 ,所 以 没有 得 到 广泛 应 用 。 
Crassidis 和 Markley 基于 MME 准则 ,将 预测 跟踪 技术 应 用 于 一 般 的 估计 问 
题 ,提出 了 可 实时 实现 的 非 线性 预测 滤波 (Nonlinear Predictive Filter, NPF), ffig 
在 动态 方程 存在 着 显著 模型 误差 的 情况 下 获得 精确 度 比较 高 的 状态 估 值 。 
考虑 非 线性 连续 -离散 时 间 系 统 模型 
£(t) = fx] +G d) (9.7.1) 
y = [xG )]+ w (9.7.2) 
式 中 , x(z) 是 n 维 的 状态 向 量 ; d(z) 是 9 维 的 系统 模型 误差 向 量 ,可 以 是 任意 的 形式 
与 分 布 ; G[x(2) ] Æ nX q 的 模型 误差 分 布 矩 阵 。y% 是 离散 的 m 维 观测 向 量 , o, 是 m 
维 观测 误差 , 且 w 一 NCO,Re) 。 
所 谓 的 最 小 模型 误差 就 是 选取 如 下 泛 函 


J[adDJ= 寺 {y(t AD — et ADYTR (yG AD — 90+ AD) 
tirom (9.7.3) 


作为 代价 函数 ,由 测量 残 差 et 十 At) = yG: + Ar) — $G + At) 的 加 权 平 方 和 与 模型 
修正 项 的 加 权 平 方 和 两 部 分 组 成 。 式 (9. 7. 3) 中 , W ERER qX q 维 半 正 定 加 权 和 矩 
阵 , 要 求 满足 如 下 的 协 方差 约束 条 件 

(y, —hC&)) (yy A)T ~ Risk = 1pm (9.7.4) 
即 估计 输出 AGO 要 求 与 实际 的 测量 值 相 适应 :“ 测 量 值 -估计 测量 值 >( 测 量 残 差 ) 的 
协 方差 与 “测量 值 -真实 输出 值 ” 的 协 方差 近似 相等 。 
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At = t — h 是 采样 间隔 ,一 般 设 采样 速率 是 常 值 , 则 yG + At) = Yen), 而 
$G + Ar) 是 将 输出 估计 yG) 作 如 下 Taylor 展开 , 即 
$G + AD = $G) HZL AHAS Jd(t) (9.7.5) 
式 中 


P, 
ZE, a= X) ALe) 
k=l ` 
pi = 1,…,m 是 对 hl] E58oR SSF38408 A EO 直到 dG) 的 元 素 出 现 最 低 阶 的 


数 。 Lihi) Æ hila) 关于 SOO 的 & 阶 李 导 数 ; A(Az) 是 mXm 维 的 对 角 和 矩阵 ,对 角 
TRH d = A/p, ¿= 1,…,m; SEO] 是 mXg 维 的 矩阵 ,其 构成 元 素 为 


~ L rE 
s = Ls [LKÂD] el, i Lenmj=1,=q 


式 中 , g; 是 矩阵 G 中 的 第 7 列 元 素 。 
将 式 (9. 7. 5) 代 入 式 (9. 7.4) ,并 将 JAO] 关于 d(z) 最 小 化 ,可 求 得 模型 误差 
表达 式 











d()=— [AADS T:R12ACADSCGD +W) [ACADSCZ)] 
XR[ZG, AD — yG + AD +$] (9.7.8) 
从 上 述 分 析 过 程 可 以 看 出 , 非 线性 系统 模型 中 的 “不 确定 ”部 分 即 模型 误差 da) 
是 作为 “确定 形式 ”的 量 而 估计 ,而 不 是 简单 地 作为 高 斯 随机 过 程 而 处 理 。 与 传统 滤 
波 方法 的 “预测 -滤波 ”的 步骤 相反 ,NPF 的 滤波 过 程 采 用 的 是 “滤波 -预测 的 程序 ， 
即 先 利用 t 十 Az 时 刻 的 测量 值 估 计 [z£ + Ar] 时 间 内 的 模型 误差 de), 再 利用 dG) 
修正 状态 方程 ,通过 方程 的 求解 实现 状态 估 值 的 非 线性 传播 。 所 以 ,其 最 优 估 值 不 
是 由 条 件 均值 给 出 ,而 是 根据 最 小 模型 误差 准则 而 修正 的 状态 方程 的 解 。 
例 9.3 用 NPF 设计 飞行 器 的 非 线性 状态 估计 器 。 姿 态 参数 选 为 四 元 数 。 这 
不 仅 因为 四 元 数 是 全 局 非 奇 异 的 ,更 主要 的 是 因为 在 预测 滤波 中 不 出 现状 态 的 误差 
协 方差 矩阵 ,四 元 数 的 归 一 化 是 隐 含 的 。 
D 仿真 模型 与 条 件 设置 。 
首先 定义 状态 向 量 为 x(z) = [q Oo (DT7]。 在 动力 学 模型 中 可 能 含有 力矩 模 
型 误差 (用 dO 表示 ), 则 状态 方程 如 下 
Aila o], [065 
xD = f[zG)3H- Ga) = | RST Hepo 


式 中 
万 [aCD,a(D] 一 4 一 去 Oo)g 


Jfa[o G) ]= ó = J! [NGO — ot) X Ja (O J 
GO = [O0 JDT, 为 模型 误差 分 布 矩阵 
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姿态 测量 选用 基于 星 敏 感 器 的 双 矢 量 观测 方案 ,并 假设 两 个 敏感 器 的 观测 精度 


相同 。 观 测 方程 为 
_ [A[qG) Jr, 
ya) = Gio ow 

(2) 仿 真 条 件 。 
设 系 统 的 模型 误差 为 干扰 力矩 AN, 由 常 值 项 A N. 和 周期 项 A N. 构成 : 
AN. =0.001X[—3 一 3 4J'(N.m) 
A N. = 0. 001 X [2cos(wot) sin(wt) —sin(wt)JT(N. m), = (4y 

49.96 2.68 0.24 
惯性 矩阵 : J= Ë 68 55.40 aze jo * m°) 

0.24 0.24 63.00. 
惯性 姿态 真实 初始 值 : 4(0) 二 [0 0 0 1J 


惯性 姿态 初始 估计 值 : 9(0) = [sncs’ Bana’ Being’ cosG35 | 
初始 估计 角速度 和 真实 角速度 : ó(0) = w(0) = [0 0 0C) 
矢量 观测 噪声 标准 差 : cu = 30” 

模型 误差 加 权 阵 : W = 90350 X Is 

(3) 仿 真 结果 。 

仿真 结果 如 图 9. 10 一 9. 11 所 示 。 其 中 ,图 9. 10 是 dG) 的 估计 误差 ,图 9. 11 是 


状态 四 元 数 的 q(z) 的 估计 误差 。 














二 oo - p 





300 400 50 60 70 80 900 100 
时 间 /s 


图 9. 10 模型 误差 向 量 的 估计 误差 
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图 9.11 用 NPF 估计 的 四 元 数 误差 


9.8 各 种 非 线性 滤波 器 之 间 的 关系 


上 面 介绍 的 各 种 非 线 性 滤波 器 之 间 并 非 是 孤立 的 ,而 是 有 一 定 的 联系 ,并 且 有 
些 方法 在 一 定 的 条 件 下 可 以 相互 转化 。 图 9. 12 给 出 了 它们 之 间 的 关系 ,下 面 对 此 关 
系 图 作 简 要 的 说 明 。 

(1) 对 于 任意 一 个 滤波 问题 , 获得 其 精确 解 的 基本 方法 是 利用 贝 叶 斯 估计 法 。 
但 是 ,对 于 非 线性 系统 , 贝 叶 斯 估计 不 存在 闭 形式 的 解 ,因此 采用 各 种 到 近 非 线性 滤 
波 的 方法 。 

D 非 线性 预测 滤波 (NPF) 在 形式 上 不 同 于 贝 叶 斯 估计 及 基于 贝 叶 斯 框架 的 其 
他 逼近 方法 , 它 是 将 跟踪 技术 引入 估计 领域 的 一 种 新 的 逼近 非 线性 滤波 方法 。NPF 
基于 一 种 新 的 估计 准则 (MME 准则 ) ,在 统计 意义 上 实现 估计 最 优 。 在 作者 的 非 线 
性 滤波 及 其 在 姿态 确定 和 导航 中 的 应 用 ?中 提出 的 自 调整 加 权 的 NPF 方法 中 ,将 模 
型 误差 估计 公式 中 的 加 权 和 矩阵 取 为 模型 误差 协 方差 的 逆 , 那 么 NPF 算法 在 形式 上 是 
一 种 闭合 的 卡尔 曼 滤波 器 。 

(3) 由 于 贝 叶 斯 估计 的 精确 解 是 状态 的 条 件 概率 密度 函数 (PDF) 。 基 于 统计 的 
观点 ,可 以 考虑 用 大 量 的 采样 点 直接 逼近 PDF, 这 就 是 Monte-Carlo 模拟 的 思想 。 粒 
子 滤波 是 最 常见 的 一 种 Monte-Carlo 方法 。 

CO 对 中 叶 斯 估计 器 最 常用 的 逼近 方法 是 假设 系统 的 状态 及 噪声 均 满足 高 斯 分 
布 , 这 种 情况 下 得 到 的 是 高 斯 滤波 器 。 但 是 ,为 了 解决 高 斯 滤波 器 的 无 限 积分 问题 ， 
还 必须 使 用 其 他 的 逼近 方法 。 

(5) 对 高 斯 滤波 器 最 基本 的 逗 近 方法 是 直接 逼近 它 的 无 限 积分 。Gauss-Her- 
mite 滤波 器 (GHF) 是 比较 典型 的 方法 , 它 采 用 Gauss-Hermite 正 交 准则 ,用 正 交 级 
数 和 逼近 积分 。GHEF 在 形式 上 与 统计 线性 回归 方法 很 相似 。 
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(6) 对 高 斯 滤波 器 比较 简单 的 逼近 思想 是 ,对 无 限 积分 中 的 非 线 性 函数 用 截断 
的 Taylor 级 数 逼 近 ,EKF 和 二 阶 滤波 器 就 是 分 别 对 Taylor 级 数 在 一 阶 项 和 二 阶 项 
后 截断 的 结果 。 这 种 方法 的 前 提 是 被 积 的 非 线 性 函数 可 导 。 

(7) 对 高 斯 滤波 器 的 一 种 比较 新 的 逼近 方法 是 基于 统计 线性 回归 的 方法 ,相应 
的 滤波 器 称 为 Sigma 点 卡尔 曼 滤波 器 (SPKF) , 比较 典型 的 是 UKF。 对 于 一 维系 统 
(n 三 1 的 情况 ), 当 UKF 中 的 参数 二 2 时 ,等 价 于 Gauss-Hermit 滤波 器 中 m= 一 3 的 
情况 。SPKF 中 的 另 一 种 方法 是 CDKF, 它 的 一 阶 算法 和 二 阶 算法 对 应 于 EKF 和 二 
阶 滤波 器 ,分 别 将 其 中 的 微分 用 差分 替代 。 


i 


以 正 交 高 斯 级 数 和 直接 通 近 积分 5 


š š 

Ë 在 二 阶 项 后 截断 | 一 

布 Braylor 级 数 二 阶 滤波 器 (SOF) 
Ë 8 poem - 





逼近 非 线性 函数 | 在 一 阶 项 后 截断 





















以 确定 采样 通过 高 类 状态 变量 
























nesk 卡尔 曼 滤波 器 (KF) 
以 不 确定 采样 
通过 状态 的 PDF [asp | F) 








基于 MME 准 则 非 线性 系统 


rT Tr 
图 9.12 各 种 非 线性 滤波 方法 之 间 的 关系 框图 
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9-1 研究 标量 系统 
dzl) =— [z(t) +ar (0) Jdsz+ [1 + hz2 () Idg) 
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及 采样 数据 观测 具有 下 列 形 式 

zk)= sinz Ct: D+ u Cti) 
式 中 , AO 为 布朗 运动 ,具有 方差 参数 Q ; u= C) 为 离散 时 间 高 斯 白 噪声 序列 ,其 均值 为 0, 方 差 为 
Rs。 初始 状态 z Cu > 0933931829 zo, 方差 为 P。, HEI AO 和 ua Ca) 互相 独立 。 试 求 信号 的 最 优 
估计 2a). 

9-2 考虑 具有 下 列 标量 形式 模型 的 状态 估计 问题 。 

dz(t) =— [aiz(t) +a, (t) + asz? (t) Jdt + [b + b z(t) + bz (t) JAR) 
采样 数据 观测 模型 为 
zD = [artid Hear Ct Dj cam Ci) J+ ult) 
其 中 , AO 为 布朗 运动 ,扩散 参数 为 Q; 1Co) 为 高 斯 随机 变量 ,均值 为 0, EN Po; w 为 零 
均值 高 斯 白 噪声 序列 ,方差 为 R。 假设 xp) ,BD) 及 w (i) 互相 独立 , 试 建立 一 阶 非 线性 滤波 器 。 
93 一 阶 系统 信号 模型 和 测量 模型 为 
l) =— P GQ) + wt) 
z(t) = zl) + v(t) 
它们 由 零 均值 高 斯 白 噪 声 w(z) 和 wz) 驱动 。 试 构造 该 系统 的 扩展 卡尔 曼 滤波 器 。 
94 设 信 号 和 观测 模型 如 下 
tlt) 一 一 sinz(z) + wl) 
z(t) = P (t) + olt) 
其 中 , zw(t) 和 uC) 为 不 相关 的 高 斯 白 噪 声 ,它们 的 均值 为 0, 方差 参数 分 别 为 Q 和 RR。 试 给 出 近似 
二 阶 矩 滤波 器 方程 。 
9-5 一 个 具有 初速 度 的 物体 垂直 向 上 的 运动 方程 如 下 
my =— mg — Dy| y| 
RP, y 为 向 上 的 测量 位 移 , m= 0. 5kg, g = 9. 807m/s ,D = 1. 4 X 10*N/ (m/s)? (阻力 系数 )。 
假设 阻力 系数 为 常 值 。 由 于 阻力 与 速度 的 平方 成 比例 ,所 以 该 差分 方程 是 非 线性 的 。 令 初始 条 件 
2(0) 一 0,3(0) =85, 每 间隔 0. 1s 记录 一 次 测量 位 移 。 测 量 误差 为 0. 25。 由 于 初速 度 不 确定 及 阻 
力 模 型 不 精确 ,实际 的 轨迹 肯定 会 与 计算 轨迹 不 同 。 假 设 初始 位 置 已 知 ,初速 度 为 一 个 服从 
NC85m/s,1m* /s°) 分 布 的 随机 变量 。 建 立 线性 离散 卡尔 曼 滤波 器 模型 。 

9-6 自主 天 文 导 航 方法 是 在 轨道 动力 学 的 基础 上 ,利用 测量 得 到 的 天 文 观 测 信息 ,通过 最 优 
估计 的 方法 得 到 航天 器 的 导航 信息 。 航 天 器 一 般 的 轨道 动力 学 是 非 线性 方程 组 ,可 采用 卡尔 曼 滤 
波 方 法 。 假 定 航天 器 是 在 太阳 坐标 系 下 描述 的 , 且 只 受 太 阳 引 力 , 轨 道 运动 为 一 个 二 体 运动 问题 ， 
则 其 轨道 动力 学 方程 如 下 


aw = u(t) 
exo = xG) 
EO 一。 
© — EB +w. D 
eO 32 +u (0) 
do, (£) ZO | w, (O 
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rD = /ZG) +y ZG 
AP, z(D yG) .z(0O u CE) ,u CE) #l u (a) 分 别 为 探测 器 在 X.Y 和 2 三 个 方向 的 位 置 和 速度 分 
量 , rO 为 探测 的 位 置 向 量 , w 为 日 心 引 力 常 数 ，r. CG) w, (9 和 w, (z) 是 均值 为 0 的 白 噪声 。 
试 将 上 述 非 线性 方程 写 为 线性 离散 化 形式 并 给 出 卡尔 曼 滤波 方程 。 
9-7 已 知 一 非 线 性 系统 的 系统 方程 如 下 


= p= e —Vacosp(t) | 


— LV,coso(t) + V,sino(z) J 
z(t)= Hrt) + (t) 
式 中 , H=[1, 0 JO 是 零 均 值 方差 为 天 的 高 斯 白 品 声 。 试 建立 该 系统 的 离散 线性 系统 方 


程 并 给 出 卡尔 曼 滤波 方程 。 
9-8 设 系统 的 状态 方程 为 
I + (t) =— 2a (t) + 2$ (t) +a (t) 
ata (t) =— 2x: (t) +w (CE) 
观测 方程 为 





zk) = [=a eo 
RP, w(t) = [un GO ux G) JT fl oG) 是 均值 为 零 的 高 斯 白 噪 声 , Q= diag[10 101, 观测 噪声 
方差 矩阵 为 R = diag[0.1 0.1], 系统 噪声 方差 矩阵 取 初 值 xC0) = [10 5]T7,P(0) = 
diag[100 101. 用 Unscented 方法 进行 滤波 并 估计 系统 的 状态 。 
9-9 系统 的 状态 方程 为 
0 


一 1 
0 


(十 1) 一 wk) 


s. 
ooooor- 
oorooc 
oooooo 

corog 


观测 方程 为 
zs (R)zs (k) + zz (k) ze (k) 
z) = | T Ck) + k) e 
T VEO TÍ GQ) 
式 中 ,+ 二 [z zs zs x zs zsJj™。w(k) 和 wk) 是 均值 为 零 的 高 斯 白 噪声 。 初 值 x(0) 一 
Co 10 1 0 10 1J', 系统 噪声 方差 矩阵 Q== diag[LO 0 0.25 0 0 0.25], 观测 噪声 方 
ŽEH R= diag[0.01 0.01],P(0) = diag[400 1 0.04 400 1 0.04]。T 为 采样 周期 ， 
取 为 0. 1s, 选 取 100 个 粒子 数 ,采样 粒子 滤波 估计 系统 的 状态 量 。 
9-10 利用 EKF 研究 如 下 问题 。 考 虑 对 穿 过 大 气 的 自由 落体 进行 跟踪 的 一 维 跟踪 问题 ,假定 
物体 沿 直线 下 落 , 直 接 对 着 跟踪 的 雷达 ,如 下 图 所 示 。 
状态 变量 给 定 为 
m = Lrt: = t, = B 


式 中 , z+ 是 物体 距离 地 平面 的 高 度 , 8 是 落体 的 弹道 系数 。 
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落体 的 运动 方程 为 


+ T à 
+ |= |= d= e= Re 
$s 0 


式 中 , d 是 阻力 减速 度 , g 是 重力 加 速度 , p 是 大 气 密度 ( po 是 海平 面 大 气 密度 ) , ke 为 误 减 常数 。 

假设 连续 测量 方程 为 
z(t) = z (t) +t) 
RP, v(z) ~ NO, R), 假定 状态 初 值 为 


1(0) po 0 0 
z(0) = [o] „P = | 0 px 0 | 
3(0). 0 0 pw. 


给 定 主要 仿真 参数 如 下 
p = 3.4X103bst/ ft, g = 32.2 ft/s 
k, = 22000ft， R? = 100 ft? /Hz 
2 (0) = 10 ft, puo = 5 X 10 ft 
z (0) 一 一 6X 10°ft/s, pm = 2 X 10 ft /s* 
z (0) = 2X 10°b/ ff, ps = 2.5 X 105b? / ftt 
B~ N(2000b/ft ,2. 5 X 105b? /ft) 
注 ; 1b = 0. 45359237kg, 1ft = 0. 3048m, 
9-11 一 维 离散 系统 的 数学 模型 描述 如 下 


_252(k) | ; u 
z(k+ 1) = 0.5z(k) + I-22 +8cos[1. 2(k— 1) + wk) 


观测 方程 为 
= ZG) 
ID = S tW 


设 wA) 和 wk) 是 均值 为 零 的 高 斯 白 噪声 序列 ,方差 分 别 为 10 和 1。 给 定 初 值 x(0) = 0. 1。 试 采 
用 粒子 滤波 算法 求 状 态 z(&) 的 估计 值 。 
9-12 题 9-10 的 状态 变量 不 变 , 但 是 将 第 三 个 状态 变量 改 为 1/B.。 考虑 一 个 二 维 跟 踪 问题 ,其 
中 距离 测量 如 下 图 所 示 。 
每 隔 ls 对 测量 值 进行 采样 ,测量 函数 是 高 度 的 非 线 性 函数 , 即 
x = VAF G. — rt +u,u ~ NOR) 
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给 定 主要 仿真 参数 如 下 


pg = 0.102b/fë 
= (0) = à (0) = 3 X 10°ft,z; (0) 一 名 (0) = 2 X 10°ft/s 
zs (0) = 2 X 102 fë /1b,#, (0) = 6 X 102 f /1b 
分 别 利用 EKF 和 UKF 研究 此 二 维 跟踪 问题 。 


第 10 章 自 适应 卡尔 曼 滤 波 


内 容 提 要 对 于 系统 模型 不 准确 及 骂 声 统计 特性 未 知 的 情况 ,介绍 了 几 种 常见 
的 自 适 应 卡尔 曼 滤 波 方法 。 


10.1 3 È 


卡尔 曼 滤波 器 的 应 用 要 求 系统 的 数学 模型 和 噪声 统计 特性 的 先 验 知识 ,但 是 在 
许多 实际 的 应 用 问题 中 ,它们 是 未 知 的 ,或 者 只 有 部 分 是 已 知 的 。 如 果 应 用 不 准确 
的 数学 模型 或 噪声 统计 特性 设计 卡尔 曼 滤波 器 ,将 使 滤波 器 的 性 能 下 降 , 产 生 较 大 
的 估计 误差 ,甚至 使 滤波 发 散 。 解 决 这 个 问题 ,产生 了 自 适应 卡尔 曼 滤波 。 自 适应 
卡尔 曼 滤波 就 是 在 进行 滤波 的 同时 ,利用 观测 数据 提供 的 信息 ,在 进行 递 推 滤波 的 
同时 ,不 断 地 在 线 估计 和 校正 模型 参数 或 噪声 统计 值 或 滤波 增益 矩阵 , 以 减 小 状态 
估计 误差 ,提高 滤波 精度 。 

根据 对 系统 数学 模型 和 噪声 统计 先 验 知识 掌握 的 情况 , 自 适应 卡尔 曼 滤波 问题 
可 大 致 分 为 三 类 ， 

(1) 系 统 模 型 和 观测 模型 精确 已 知 ,噪声 统计 值 (一 般 是 均值 和 协 方差 ) 未 知 。 

这 类 自 适应 滤波 问题 归结 为 噪声 统计 的 估计 或 稳 态 滤波 增益 阵 的 估计 问题 , 比 
较 经 典 的 方法 是 Sage 和 Husa 常 值 噪声 统计 的 次 优 无 偏 极 大 后 验 (MAP) 估 值 器 ,这 
种 方法 适用 于 一 般 的 时 变 线性 离散 系统 。 

(2) 系 统 模型 和 测量 模型 近似 已 知 ,噪声 统计 值 已 知 或 未 知 。 

这 类 问题 的 解决 方法 是 引入 虚拟 噪声 ,将 自 适应 滤波 问题 转化 为 带 未 知 时 变 品 
声 统计 系统 的 自 适 应 滤波 问题 。 

(3) 系 统 模 型 和 测量 模型 及 噪声 统计 值 都 是 未 知 的 。 

解决 这 类 问题 主要 有 两 种 方法 。 一 种 是 参数 和 状态 估计 互 看 的 方法 ,通过 在 线 
联 立 递 推 的 方法 估计 未 知 的 模型 参数 和 噪声 统计 ; 另 一 种 方法 是 自 校正 滤波 器 。 

下 面 分 别 对 这 儿 种 情况 下 的 滤波 问题 进行 讨论 。 


10.2 ”噪声 统计 特性 未 知 的 自 适 应 滤波 器 


线性 动态 系统 数学 模型 为 
x = Dr Xi + We 《10. 2. 1) 
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r, = H,x, +w: (10. 2. 2) 
式 中 , x, 为 n 维 状态 向 量 , z, 为 m 维 测量 向 量 , Doa 和 Hi AEAEE, w, Ao 是 
相互 独立 的 正 态 白 噪声 , 且 有 
ECW) = pus Cov(w,w) = @, 
Elv) = g. Cov(v,v) = Rs 
当 噪声 统计 特性 已 知 时 ,卡尔 曼 滤波 器 为 


ls = Ke +K, (10. 2. 3) 

Er = z, — Hye — Ho (10. 2. 4) 
Cl = Dik F pw (10. 2. 5) 

K, = Pam HI [HP Hí +R] ' (10.2.6) 
Pia = DeeP Dkm +Q Q0.2.7) 
Par = [I— KH JPue (10. 2. 8) 


初 值 为 





oo = E(xo) = Xo, Poo = Var(xo) = P, 
10.2.1 极 大 后 验 (MAP) 了 噪声 统计 估计 器 


当 噪声 均值 ks fil, 和 方差 阵 Q 和 R 未 知 时 ,基于 测量 序列 (zi ,zo，,… ,zi) RR 
声 统计 估计 器 和 卡尔 曼 滤波 器 的 问题 ,就 是 自 适应 滤波 问题 。 








令 
XK" Ck) = [xo xi "° xa] 
Z* (k) = [zu zz," za] 
由 贝 叶 斯 公式 有 
PCX" (k) na Q, R | Z° CD)) 
PZ* (k) | X° spose OPA spe (10 2 9) 


由 于 AZ A) 与 最 优化 无 关 , 因 此 式 (10. SI AREORA 
问题 , 即 
J= p(Z* Ck) | X* Ck) Qu R)p(X: (k) | pws pe R) 
X Hla) HCO) Ppp) PR) (10. 2. 10) 
假设 心 .Q.we 和 R 相互 独立 且 服 从 均匀 分 布 , 即 
Du) -— Huimin L pui < Primaz 
0, 其 他 


1 
TaT a Qinin < Qui < Q... 


PQ) -1 
0， 其 他 
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1 a asa, 
DP(aa) = = = Pasa E pe E pi 
0, 其 他 
1 
一 R 一 ， Rao 一 Ru < R<. 
pro =R a= PAS 
0, 其 他 
式 中 , pu Qi pu Ri DIA pe Q pR 的 分 量 。 


由 Wi、w 的 正 态 性 可 知 
k 
PE’ (k) | pus Qype R) = pCxo) [[ Cx; | xr spa Q) 


j=1 


=C: | P |T | Q exp HE l x —x lo 








+D la Dam — pe lb: J) a0. 2. 11) 
AH, JUJA = UAU 为 二 次 型 ,| .| 为 矩阵 行列 武 。 
类 似 有 
PCZ" Ck) | X* (k) ,psQ HR) = He, | xj spv R) 
=C IR taty la- Hx —p, lli) (10. 2. 12) 
于 是 ,有 


k 
J=G 18| IR tep -H laa |b + eBt m ll] 
2 名 


k 
一 二 la -Hx -p li) (10. 2. 13) 
= 
k k 1 < 
hJj=-—zh|Q]—2n|R|— 2 Iz Daix —p |: 








k 
一 > lz — Hx: — m i: +C (10. 2. 14) 
i=] 


注意 到 J 和 nJ 有 相同 的 极 值 点 ,并 利用 
总 mdetx = (zT 


tr GB) =— Gr Bx)" 


WW [LT tr Vo 
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令 














aJo, AJo, AJ o, Ao 

pw e ake Yr Q ” R 

则 得 噪声 统计 值 极 大 后 验 (WAP) 估 计 为 

B.G) = +L =D] (10. 2. 15) 


i 
ñQ) = Diy — Hitu] (10. 2. 16) 
= 








A 
QW = [ta Dritan pa] Ci = Datan pT 
(10. 2. 17) 








š 
RG) Fs Hi — p] [z; — Ht —p] G0.2.18) 


如 以 滤波 估计 名; 或 预报 值 Ej 近似 代替 式 (10. 2. 15)— (10. 2. 18) 中 的 平滑 估 值 
Sis 则 可 得 次 优 MAP 估计 器 为 


ñ.GQ) = + [8 — Batam] (10. 2, 19) 


a= IM- 


i 
D [z — Ham] (10. 2. 20) 


B.G) = 


k 
AD= F DLB = Dat = pully 
Z Bt 一 本 a0. 2. 21) 


k 
RO = + Ylen -He — s [sa Hte] (10. 2,22) 


10.2.2 次 优 无 偏 MAP 噪声 统计 估计 器 


下 面 证 明 MAP 估计 器 是 无 偏 的 。 
由 式 (10. 2. 3) 及 式 (10. 2. 8) ,有 
i 
ELA] = FD EK e; +n.) = pu (10. 2. 23) 
i=) 
1 
EAD] = + Et +u.) = n, (10. 2. 24) 
a 
由 于 Er = z Hae — po = Hiroe Tu p 





k k 
ERW] 一 二 六 Eeey) = ED HPH +R) 
名 = 
因此 ,得 尺 的 次 优 无 偏 MAP 估计 器 为 
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RO = LS esj up, HD (10. 2. 25) 
再 由 
EÔ) ]= TEKEGDK 
= FOP = FPP, 
;. SoPa u +Q 《10. 2. 26) 
得 Q 的 次 优 无 偏 MAP 估计 器 为 


Ôk) = 15 (KejElK] + P,, — O; j IP, 1 Da) (10. 2. 27) 
i=l 
进一步 ,由 式 (10. 2. 19) 、 式 (10. 2. 20), 以 及 式 (10. 2.25) 和 式 (10. 2. 27) 得 
Ê.(k+1) = ZHU. + teni AH 一 Oria J (10. 2. 28) 


BGD = HUA + na Hiten] (10. 2, 29) 
ORED = ECO) + Kiem KE + Pinen — @aa Pa Ohia] 
(10.2. 30) 


RG oL) 一 iuw Fernet — Hm Peis HË ,J (10. 2. 31) 


10.3 有 色 测 量 噪声 系统 的 自 适应 滤波 器 


当 测 基 误差 为 有 色 噪 声 ,上 且 可 以 由 成 型 滤波 器 实现 时 ,其 线性 离散 时 变 系 统 数 
学 模型 为 


Xen 一 Burax HW (10.3.1) 
Zm = Hen Xe 十 ma (10. 3. 2) 
Wn = Biia W HG (10. 3.3) 


式 中 , x, 29 n 维 状 态 向 量 , z, 为 m 维 测量 向 量 , o, 为 有 色 测量 噪声 。w 和 为 相互 
独立 ,上 且 方 差分 别 为 C 和 RR 的 高 斯 白 噪声 , 即 
Elw]=0, ELw,w]= Qs 
E[&]J=0, Elgg] = Ry 
Cov(w,,8;) = 0 
假定 初始 状态 x, 和 o; 是 与 w 和 64 相互 独立 的 高 斯 随机 向 量 , 且 有 
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Exs =xa E[xa,x2] = Ps 
Ev = 0, Elw, w] = S 


以 下 分 几 种 情况 讨论 。 
1.Q 和 及 已 知 
34 Q 和 R 已 知 时 , 式 (10. 3.1) 一 (10. 3. 3) 所 描述 系统 的 线性 卡尔 曼 滤波 方程 为 
fenn = feni + Kenigen (10. 3. 4) 
£a = Orifi (10. 3. 5) 


Koi = [Pi HË — BsPusHIBE [He Penn H Ea 
— Haen Øri P, Hin Bin, — Ben AHP aOR HË, 
+ Bir HiPa HEBE +R] ° (10. 3. 6) 
Pirie = @raaPu ka, +Q (10.3.7) 
Ponien = U — Krn Hin Pori Kei Ben Hii Pass (10. 3. 8) 
= z — Benita — [Hrn Detia — Bra H,J$, 
= yin — [Hrn Ørn — BeH Jis (10. 3. 9) 
Je = Zn — Binata = Henxi — Bra Hix, HEr, Yo = zo (10. 3. 10) 
注意 , 式 (10. 3. 10) 是 因果 可 逆 的 线性 变换 ,因此 测量 过 程 x 与 y, 是 等 价 的 ,测量 集 
Z° (k) A [zoss] 





Btrl 


与 

Y' G) A [yi ys, yr] 
含有 相同 的 统计 信息 ,但 是 对 Y* Gk) 而 言 , 测 量 噪声 为 白 噪声 ,这 对 求解 C MR 的 
MAP 估计 器 是 很 方便 的 ,可 用 极 大 后 验 概率 密度 得 到 。 


由 贝 叶 斯 公式 有 
PLX" k) Q,R | Y* GD] = YUG A (h O.R] (10. 3.11) 
AF 


X° (k) A [xo xi wa] 
由 式 (10. 3. 11) 可 知 , PY (&)] 与 最 优化 无 关 , 故 Q 和 R 的 MAP 估计 器 可 由 下 列 
的 条 件 概率 密度 极 大 化 求 得 , 即 
J= pY’ (k), X" (k),Q,R) 
= p(Q) PR)PLX* (k) | Q,RIPLY* Ck) | X: (k), Q,R] (10. 3. 12) 
如 果 Q 和 R 相互 独立 ,服从 均匀 分 布 , 且 x 与 Q 和 R 相互 独立 ,利用 式 (10. 3. 1). 
得 


i 
PX* Ck) | Q,R)= p(x;) [[ p: | xQ) 
i=] 
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= (P | p, > | g eph |x —x k 


i 
+> le Bx l) (10. 3. 13) 
i=l 


式 中 , |U |? AUAU. 
` HF yo = zo = Hox +w, W xo AI o Ef H 2h sy K RE REDLER E 
率 密度 pCyo。 | xo) 也 是 高 斯 随机 变量 。 由 条 件 概率 密度 的 性 质 及 式 (10. 3. 10) 得 


k 
DY GQ) | X*k) Q, R= plyo | x.) [[ DO: | xxi R) 
= G= |s, [H | RI4ep|— + I yo — Hx |& 
k 
+) ly Hx tB mH a |) 0.3.14) 
名 


于 是 ,有 
J=c|o!4 |R tep} lx — lk — + l — Ho | 





k k 
-FÈ lx—@asa legh ly Hz +B. aB [ka] 


(10. 3. 15) 
S 


489 Q AIR 的 MAP 估计 器 为 
n 
Ô) = PAE Ofan] [fs — Bit] (10. 3. 16) 


Rk) = Diu- = Hiin HB, Hasu] 


X [ir — Hifi + Bim Hsn] (10. 3. 17) 
AI $ A 近似 代替 式 (10. 3. 16) 一 式 (10. 3. 17) 中 的 名 和 jx, 则 得 Q 
FR Hè MAP 估计 器 为 


Ô+) = 二 Knenel Ki (10. 3. 18) 


k 
Rap + TÈ sasha (10. 3. 19) 
由 于 
k 
Elk + 1)]= FELIP Hk, —@a.PuHTB1, KY 
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PE 


a 
12 LD PD, — Pan] +O (10. 3. 20) 
[ 


asb: 

" 
EL[R(k+ DJ]= 412 
— Hin Din Pi Dia HIB + BaiHPHIBH, ] +R 


HP HY — Bi H P. bk, 


(10. 3. 21) 
于 是 ,得 C 和 R 的 次 优 无 偏 MAP 估计 器 为 
Ô+) = THÈ > [Kinemel Ki + Pi — O; P bk... J 
(10. 3. 22) 


k I 
RG +1)= THÈ [erisia — Hian Pin Hii + Bii HPDH fa 
= 


+ Hin DaPin: phi HTB: — Bi H P. HIB1 ] (10. 3. 23) 
进一步 ,得 Q 和 R 次 优 无 偏 MAP 估计 器 递 推 方程 为 


Qk 二 1)= zU + Knsmel KE 
+ Pn — OPa Oha] (10. 3. 24) 
RG +1)= 已 [县 人 +emeh 一 Him P, a Hina 
+B. H P. ph. HE + Hn D, P. pai HTBL, 
— Ban H P ,HTBL,., ] (10. 3. 25) 


这 样 , 式 (10. 3. 4) 一 (10. 3. 8) 与 式 (10. 3. 24) —(10. 3. 25) 一 起 构成 自 适应 卡尔 曼 滤 
波 器 。 由 于 Q 和 RR 的 估计 值 是 次 优 的 ,因此 相应 的 滤波 器 也 是 次 优 的 。 

2.Q 和 及 未 知 时 变 

当 有 色 噪 声 系 统 式 (10. 3. 1)—(10. 3. 3) 中 的 噪声 协 方差 阵 未 知 时 变 , 即 

E{wwl} = Q(k)6s, ELGEF) = RG), 

此 时 ,估计 器 应 逐渐 忘记 过 去 陈旧 的 数据 的 作用 ,这 可 通过 逐渐 减 小 式 (10. 3. 22)— 
(10. 3. 23) 中 的 加 权 系数 而 实现 , 即 采 用 变化 的 加 权 因 子 ,而 不 再 是 固定 不 变 的 。 加 
权 系 数 6 的 选取 原则 是 


BR-Bib0<b<1 YR =I 


式 中 , b 为 遗忘 因子 ,其 递 降 分 布 律 为 
B = dibdi = (1 —b)/Q — H), i = 0,1,--,E 
利用 指数 加 权 的 方法 可 得 
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I k 
OG + 1) = d, 27 [Kasi ghi Khi + Pisi — DPD] 


= 


(10. 3, 26) 
L 
RG +) = d, Do iTemeh — Hj, aP. an HR, 
[=i 
+B HPDi Hha + Hin @; PuHiBh. 
— BH P. HBa] (10. 3. 27) 


进一步 ,可 得 其 递 推 方程 
QG +1)= A —d4,)0G) + aLKenemnel Kh 
F Penin — @aasP, Dina] (10. 3. 28) 
RG + 1)= Q — d DRC) +d, lennel — H, Pen HT, 
+B, HiP iD HË: + H, Øri Pu HEBE. 


` — Brna HPH Bina] (10. 3. 29) 
特别 地 , 当 Brn = 0 时 , 式 (10. 3. 28) ~ (10. 3. 29) 给 出 了 白色 测量 噪声 下 的 时 变 品 
声 协 方差 阵 估计 器 , 即 
QG +1)= (1— 4d) + adiLKineneh Ki 
+Pinan — @riaP a OE] (10. 3. 30) 
ROCk+1)= Q —dORG) + dilenen — He Pr HË, 
+BaaH,P. bri HE] (10. 3. 31) 


3. Wh 和 4 的 均值 和 协 方差 阵 是 未 知 的 常 值 
当 w 和 的 均值 和 协 方差 阵 是 未 知 的 常 值 时 , 即 
Ew: = polk), Cov(w;,w) = Oy 
EG, = p(k), Cov(§; ğı) = R; 
其 MAP 估计 器 及 相应 的 卡尔 曼 自 适应 滤波 器 为 


hk+ D= HA 十 za — Ban 
— Hrn $on + Baja H, (10. 3. 32) 
uk TD = TUR. Hinn HOt] (10.3.38) 
RG +D= HRH + emei 


— Hin Pin H in + Ben H,P, DE HË 
F Hri Den aPa HIBE i, — Ben H,P, H IBE] 
(10. 3. 34) 
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QC(k+D)= i el + Kinemeln Kin 
+ Pe — BensParBhr] (10. 3. 35) 
Sela = Ski + Keriger (10. 3. 36) 
a = Dri + ñ. Ck) (10. 3. 37) 
Et = zya — Brn ata — CHin Bes — Bia aH, — Aek) C10. 3. 38) 


Kin= [P+ Hii — Or P, HIBA, ] 
X [Hin Pernu Hia — Hin Deri, Pa HR Bh 
— Bori H,Pu GE, Hin + Ben a H,P, HEBE a HJ? (10. 3. 39) 
Perk = @, ia P, 61, + OR) (10. 3. 40) 
Penin = [I — Ken Hen Pn +H Kin Benia Hin PaO (10. 3.41) 
4. m fo Gi 的 均值 和 协 方差 阵 未 知 时 变 
当 w 和 所 的 均值 和 协 方差 阵 未 知 时 变 , 即 
E[wG)] = pCj), Cov(w,,w) = Q(k)8, 
ELEG] = pG), Cov(#,,&) = Rk)ðy 
利用 指数 加 权 法 可 得 噪声 统计 值 MAP 次 优 方 偏 估 计 器 为 
应 (十 1) = (1—dOñ, Ck) + dalee — Drrake] (10. 3. 42) 
B (k+1)= A — dA Gk) + dilin — Beraza 


— Hen Êe +B... H,X,,] (10. 3. 43) 
QG + 1)= (1—4,)0G) + dLKeem el KL, 
十 PHale — 6 aP, Da] (10. 3. 44) 


RG + 1)= Q —d)ROGQ) + dilerek 
— Hin Pin Hin + B, H.P, bia HT. 
F Hin Deri aPa HEBE — Bia H, P, HEBE] (10. 3. 45) 
相应 的 卡尔 曼 滤 波 公式 同 式 (10. 3. 36) 一 式 (10. 3. 41) 。 


10.4 ” 带 模型 误差 系统 的 自 适应 滤波 器 


卡尔 曼 滤波 可 行 的 条 件 是 ,系统 模型 是 准确 的 。 当 系统 模型 中 含有 误差 时 , 估 
计 结果 会 出 现 偏差 甚至 出 现 发 散 。 下 面 重 点 讨论 线性 系统 状态 转移 矩 阵 和 测量 矩 
阵 都 含有 未 知 模型 误差 时 的 处 理 方法 。 

系统 中 模型 误差 产生 的 原因 主要 有 以 下 几 种 : 

D 由 于 对 象 过 程 的 时 变 特性 引起 模型 参数 的 漂移 ; 

(2) 系统 建 模 时 采用 的 参数 估计 的 一 致 性 及 收敛 速度 与 可 用 数据 的 数量 ， 
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(3) 用 机 理 建 模 产生 的 参数 误差 ; 
(4) 非 线 性 系统 线性 化 的 模型 误差 。 
对 于 这 些 模 型 误差 ,可 以 通过 引入 虚拟 噪声 ,将 问题 归结 为 带 未 知 时 变 噪声 统 


计 系 统 的 自 适应 卡尔 曼 滤波 。 
考虑 如 下 离散 系统 数学 模型 
Xe = Din, Xi H W (10. 4. 1) 
Zen = Hen Xen + Vr (10. 4. 2) 


式 中 , x, 为 n 维 状态 向 量 , z, 为 m 维 测量 向 量 , D 为 已 知 的 n X n MIRER E 
RE, Hen 为 已 知 的 mXn 阶 测量 矩阵 , w, 和 vi 是 相互 独立 的 具有 常 均值 和 协 方差 阵 
的 高 斯 白 噪 声 。 

假定 式 (10. 4. 1) 及 式 (10. 4. 2) 中 含有 未 知 的 模型 误差 AO... 和 AH, 即 真实 
系统 模型 为 


Xen = (Ora H ADe) X + We ao. 4. 3) 
Zen = (Hm + AHi ) Xi + vn (10. 4. 4) 
令 

m = A@,....x, + w, (10. 4. 5) 
in = AHi Xen 十 wh (10. 4. 6) 

E m Agn 为 虚拟 噪声 , 则 式 (10. 4. 1) 及 式 (10. 4. 2) 可 表示 为 
Xin = Orati + h (10. 4. 7) 
zh = HXi 十 Et (10. 4. 8) 


这 样 ,对 未 知 模型 误差 系统 式 (10. 4. 3) 及 式 (10. 4.4) 的 滤波 问题 转化 为 带 虚 拟 噪声 
系统 式 (10. 4. 7) 及 式 (10. 4. 8) 的 自 适应 滤波 问题 ,而 这 又 可 以 归结 为 对 虚拟 噪声 统 
计 值 的 估计 问题 。 

根据 式 (10. 4. 3), 真 实 系统 的 状态 可 表示 为 


k 
x, = (Dro + A@,..)x; 十 >) (Or HAD) W (10. 4. 9) 
i=l 


ARAO. 4. 9 可知, 虽然 真实 系统 噪声 w 和 vi 的 均值 和 协 方差 阵 是 常 值 的 ,但 是 系 
统 (10.4. 7) 一 (10. 4. 8) 的 虚拟 噪声 的 均值 和 协 方差 阵 却 是 时 变 的 , 即 

Elm] 一 p(k), Covi om) = 90028, 

ELE] = pe(k), Cov; i) = RGD)ë, 
严格 地 说 ,虚拟 噪声 本 身 并 不 是 白 噪 声 ,而 是 有 色 噪声 , 且 m AE 是 相关 的 。 但 是 ， 
当 模 型 误差 AO...., 和 AH 相对 较 小 时 , 则 可 近似 地 将 p 和 上 看 作 是 相互 独立 的 
ARE, 

利用 10. 3 节 讨 论 的 时 变 噪声 统计 估计 器 ,得 到 带 有 模型 误差 系统 (10. 4. 7) 及 

RAO. 4. 8) 的 卡尔 曼 自 适 应 滤波 器 方程 为 
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Renen = $k + Kentr (10.4.10) 

finije = O; + Êy Ck) (0, 4. 11) 

Eri = Zen — Hin Peri, — Âe Ck) (10. 4. 12) 

Kn = Pinn Hia [Hn Pen H in HJY (0. 4. 13) 
Pine = DraaPa OR HÊ) (0. 4, 14) 
Penin = [I— Ken Hin JP; (10. 4. 15) 


Âk +1) = (1—d)ñ,G) 十 四 [ealea H Derka] (10. 4. 16) 
应 (十 1) = O —d,)ñ éG) 十 四 [zeh — Hra fena] d0. 4. 17) 
QG + 1) = A dÂ) + dLKeemetn KE 
+ Penin — @iia Pa bF, J (10. 4. 18) 
RG -+1) = Qd DR) + dilemel — HnPranHE] (10.4.19) 
RP, di = (1 一 六 /一 st),0 一 5 一 1,0 是 遗忘 因子 。 
初始 条 件 为 








Solo » Polo ,fe (0) ,O60) ,RCO) 
除了 上 述 模型 不 确定 的 情况 以 外 ,还 有 其 他 情况 。 例 如 ,系统 模型 中 含有 未 知 
参数 的 情况 。 这 时 ,可 以 采用 第 7 章 的 状态 增 广 法 ,将 参数 作为 系统 模型 的 增 广 状 态 
进行 估计 ;如 果 系 统 噪声 w 含有 误差 ,甚至 误差 形式 不 确定 时 ,可 以 采用 第 9 章 介 绍 
的 预测 滤波 法 ,通过 实时 估计 模型 误差 以 校正 系统 模型 ,然后 通过 求解 常 微 分 方程 
的 方法 求解 系统 的 状态 。 


10.5 参数 和 状态 互 耦 的 自 适 应 滤波 器 


如 果 系 统 中 的 参数 和 状态 是 耦合 的 ,可 以 采用 分 别 估计 的 方法 , 即 先 估计 参数 ， 
再 估计 状态 。 
考虑 如 下 的 离散 系统 数学 模型 
Xin = AO) x + B(0)u, + f, (10. 5. 1) 
Ze = Hri Xe + Ven (10. 5. 2) 
AP, x, 为 n 维 状态 向 量 , u, 是 之 维 已 知 的 输入 向 量 , z, 为 m 维 测量 向 量 ; 9 一 
[0 ,% ，…b 了 为 矩阵 A.B 中 所 有 未 知 的 参数 向 量 , H, 是 已 知 的 测量 矩阵 ;模型 品 
声 f, 和 测量 噪声 w 是 相互 独立 的 ,具有 常 均值 和 协 方差 矩阵 
Ef, = prk), Cov(f,,f,) = QC(k)à, 
Eo, = p(k), Cov(o;,) = R(&)ó, 
如 果 参 数 是 常 值 , 则 有 动态 模型 
0(k + 1) = 0k) (10. 5. 3) 
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如 果 参 数 是 时 变 的 , 则 有 动态 模型 

OC(k+1) = Ck) + Ek) (10. 5. 4) 
或 

OC(k+1) = 0(k) +G) (10. 5. 5) 


式 中 , G 为 已 知 常 值 矩 阵 , EO 是 具有 未 知 时 变 统计 值 且 独 立 于 f, 和 wi 的 高 斯 白 噪 
声 , 且 
ELEC] = pelk), Cov[E(R) EGY] = SB 
以 下 基于 测量 数据 的 集合 {z ,zo。，,… ,zs}，, RRE x, 和 未 知 参数 向 量 6(A) 的 线 
性 最 小 方差 估计 。 
第 一 部 分 :参数 估计 
将 式 (10. 5. 1) 代 人 式 (10. 5.2), 有 
Zea = Hm ACO) x + H,,, B(0)u, + Hi f, ++ (10. 5. 6) 
由 于 测量 矩阵 H, EA, Ak om HEHn AO x 的 每 个 分 量 是 9 分 量 的 线性 函数 , 且 
线性 函数 的 系数 与 x, 有 关 。 类 似 地 , Hit1B(9)u 的 分 量 也 是 6 分 量 的 线性 函数 , 且 
这 个 线性 函数 与 w 有关。 于 是 ,将 式 (10. 5. 6) 写 成 关于 8 的 显 式 , 即 
Zea = Cxe st )O + d(x,,u,) + H, f, +a (10. 5.7) 
式 中 ,矩阵 C 和 向 量 d 的 元 素 与 x flu, 有 关 。 由 于 在 通常 情况 下 , A 和 了 中 的 元 素 
并 非 全 部 未 知 ,因此 d(x ,u) 表示 不 含 6 分 量 的 项 。 
在 式 (10. 5.7) 中 ,以 滤波 值 $, 近似 代替 x, ,可 得 关于 0 的 测量 模型 
zit = Crin sOkR) + dar sd) + nka (10. 5. 8) 
式 中 
ma = Hen 十 wh Her (10. 5. 9) 
e, 是 由 于 以 估计 值 2ix* 近似 代替 x 所 产生 的 测量 模型 误差 项 。 称 m 为 虚拟 噪声 , 包 
含 了 测量 模型 误差 。 显 然 , 即 使 f 和 vw 的 均值 和 方差 为 常 值 , naa 的 均值 和 方差 
也 是 时 变 的 。 
假设 
E) = p(k), Cov(mon,) = NCk)òy 
m 的 均值 及 协 方差 可 以 用 8. 3 节 讨论 的 时 变 噪声 统计 值 估计 ,对 于 由 式 (10. 5. 4) 和 
RAO. 5. 8) 构 成 的 系统 及 测量 方差 ,估计 参数 0 的 卡尔 曼 自 适应 滤波 方程 为 


0G+1)=0CG+1]| 4) +K(k+ l), (k +1) (10. 5. 10) 
Ok +1 | k) = GOC) + Alk) (10. 5. 11) 

Elk +1) = ze — CROR+1 | k) — dck) — Â, Ck) (10. 5. 12) 
P,(&+ 11 |k) = GP,(# | k)GT +Å) (10. 5. 13) 


Kilk + 1) = P;(k+1 | A)CTCGR) [CP,(k +1 | HEAT 
(10. 5. 14) 
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P,(k+1) = [I—K,(k& + 1)CGDJP,(k + 1 | k) (10. 5. 15) 
式 (10. 5. 12) 中 
CR) = Clir ta) ,dk) = dlije stla) 
虚拟 噪声 时 变 统计 值 估计 器 为 
Aek +1) = (1—b)felk) + b,[0(k + 1) — Gp (k)J G10.5.16) 
ŠG +1)= (—5)ŠG) + bK, Ck + 1e lk + Del (k + 1) 
X K (Ë+ 1) +P,(k + 1) —GP,(k)GT] (10.5.17) 
ñ,Gk+ 1) = (1 — bA Ck) Hoz — CR) 1 | k)] (10. 5. 18) 
Nk +D= A — bC) + blek + DEF Ck +1) 


一 CO)P(R 十 1 | ACTCA)] (10. 5. 19) 
式 中 
b = (1—o/(l—at),0<a<l 
第 二 部 分 :状态 估计 
在 式 (10. 5.1) 中 ,使 8 由 第 一 部 分 的 估 值 6( 十 1) 代 某 ,可 得 
Xen = A(0(k + 1))x, HBO Lu + (10. 5. 20) 
式 中 


w, = f, +[A(0) — AO + 1)) Jx, + [B(0) — BO + 1)) Ju, 
为 虚拟 噪声 ,模型 误差 被 合并 到 w 中 。 显 然 , wm 为 具有 时 变 统计 值 的 噪声 , 令 
EG) = palk), Cov(wisw) = Q(Q0D)8, 
可 以 看 出 ,即使 fi 的 均值 为 0, 只 要 ECx。) > 0 R u, > 0, W| w, 的 均值 和 协 方差 阵 也 
是 非 零 且 时 变 的 。 如 果 w 近似 为 白 噪声 , 则 对 系统 式 (10. 5. 1) 一 (10. 5. 2) ,状态 x, 


的 卡尔 曼 自 适应 滤波 为 
fenn = fena +K,(& + 1)8,(& + 1) (10. 5. 21) 
$a = ACOH LD) ina BOH 1) u 十 应 .CR) (10. 5. 22) 
e: (k +1) = zen — Hrn fena — Âp Ck) (10. 5. 23) 
K:(k+1) = P. (k +1 | DHE: [HP (k +1 | DHE, HROT 


(10. 5. 24) 
Pk +1 |$) = ACO + 1))P; ATOR H1)) HÊ) (10. 5. 25) 
P.(k+1) = [OK +1 | k)Han]P.(k +11) (10.5.26) 
测量 噪声 w 及 虚拟 噪声 w 的 时 变 统计 值 估计 器 为 
应 (十 1) = (1—BOf GQ) HALin 一 4 十 1))2 — BOC + 1)) Ju, 
(10. 5. 27) 








Ô+ D= Q—A)0G)+A[K.G: + 1)e (k +1) 
Xz#IG + DKICG + 1) +P, k+ 1) 
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—A(0G + 1))P,G)AT(0(k + 1))J (10, 5. 28) 

应 (十 1) = O AÊ k) HAL — Henen] (10. 5. 29) 
RG + 1)= APOR) + Ale k+ Dallkt+ 1) 

— HmP.(k+1 | DHE, J (10. 5. 30) 


式 中 
ñ = 1—a)/(1—atty,0<a<1 


思考 题 


10-1 在 通用 的 卡尔 曼 滤波 器 中 ,第 k 步 计算 残 差 为 (z 一 Hs) o WEAR Bai É z, 
的 最 优 估计 ,那么 此 残 差 平方 的 数学 期 望 最 小 。( 提 示 : 测 量 关 系 方程 z = H,z, +w 中 噪声 与 信 
号 不 相关 , Sl 的 值 只 与 x-: 有 关 ) 

102 设 系统 方程 和 量 测 方程 为 


G I 
XG) 一 Ë 0 t xa-v+ jwa» 
人 
0 
1 


100 
= XG) 十 VC 
ZO) Ë 网 (CD 十 VC 


按 已 知 条 件 列 写 滤波 方程 ; 
(1) W) 和 VCk) 为 互 不 相关 的 零 均 值 白 噪声 过 程 ,方差 为 2。 
(2) WQ) 和 VCk) 为 零 均 值 白 噪声 过 程 ,二 者 相关 , 互 协 方差 St) = 1, 
OVA) 为 零 均 值 有 色 噪 声 过 程 
V) = 一 VE 一 D) 十 &k 一 1) 
W(k) M E) 为 互 不 相关 的 零 均值 白 噪声 过 程 ,方差 强度 为 1, 且 & 的 方差 为 0。 
103 设 真实 系统 为 如 下 的 一 维系 统 
Zz(k+1) 一 0. 96x(k) + wlk) 
yk) = 1.05z(k) + vlk) 
式 中 , wk) 和 oCk) 是 独立 的 白 噪声 , 且 
ECw(k)]= 0,CovCwlk),w(k)]= C0. 2)? 
ECwk) J]= 0.1,CovLv(k) ,vk)I= C0. 2)? 
已 知 初 值 人 (0 | 0)= 0,PC010)==0,8(0) = 0,Q(0) = 2,# 二 0,RC0) = 2,6 = 0. 98, 利用 带 模 
型 误差 方法 进行 自 适应 滤波 。 
104 设 真实 系统 为 
z(&+ 1) = 0. 9z(&) + wlk) 
yk) = 2. 1z(&) + ok) 
式 中 , vk) 是 均值 = 0.1 B HÆR = C0. 222 的 正 态 白 噪声 ; w) 是 均值 "一 0. 01 且 方差 Q 
= (0.15) WESHRE, HAYF vk). 已 知 初 值 2(0 | 0) = 0,P(0 | 0) = 1,40) = 2,R0) 
= 2,b = 0.98, 试 对 该 系统 进行 自 适应 滤波 。 
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105 已 知 一 动态 系统 可 以 描述 为 
z(&+ 1) 一 a(&+ Dzr(k) +u) 
x. Yk) = x(k) + vlk) 
其 中 , w) 为 模型 噪声 , vC) 为 观测 噪声 ,它们 是 相互 独立 的 高 斯 白 噪 声 ; a(k) 为 随机 递增 系 
数 ,服从 广义 随机 游 动 模型 , 即 
a(k+1) = alk) + E(k) 
式 中 , 白 噪声 &k) 独立 于 wC) 和 wk), HARPERS. RAA EH HEE Wk i ht 
系统 的 多 步 递 推 预报 公式 。 
106 已 知 一 标量 系统 可 以 描述 为 
Zz(k+1) = 0.7z(&) +0. 4z(&— 1) + wlk) 
Ik) = x(k) + vlk) 
其 中 ,噪声 统计 为 9 一 r = 0,Q = R = 0.01, 初 值 为 
z( 一 1 一 0， rz(0) 一 10 
人 (一 1) =0, 2(0) 一 10 
力 ( 一 1) 一 0， p(0)=0 
噪声 统计 初 值 为 
Ro) = 0. 1,&0) = 0. 005 
利用 计算 机 仿真 该 噪声 统计 估计 器 性 能 。 
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